CN105116843B - 一种直线电机与两个旋转电机的同步控制方法 - Google Patents

一种直线电机与两个旋转电机的同步控制方法 Download PDF

Info

Publication number
CN105116843B
CN105116843B CN201510405398.1A CN201510405398A CN105116843B CN 105116843 B CN105116843 B CN 105116843B CN 201510405398 A CN201510405398 A CN 201510405398A CN 105116843 B CN105116843 B CN 105116843B
Authority
CN
China
Prior art keywords
electric rotating
rotating machine
electric motors
linear
linear electric
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.)
Active
Application number
CN201510405398.1A
Other languages
English (en)
Other versions
CN105116843A (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.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of 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 Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201510405398.1A priority Critical patent/CN105116843B/zh
Publication of CN105116843A publication Critical patent/CN105116843A/zh
Application granted granted Critical
Publication of CN105116843B publication Critical patent/CN105116843B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B19/00—Programme-control systems
    • G05B19/02—Programme-control systems electric
    • G05B19/18—Numerical control [NC], i.e. automatically operating machines, in particular machine tools, e.g. in a manufacturing environment, so as to execute positioning, movement or co-ordinated operations by means of programme data in numerical form
    • G05B19/414—Structure of the control system, e.g. common controller or multiprocessor systems, interface to servo, programmable interface controller

Landscapes

  • Engineering & Computer Science (AREA)
  • Human Computer Interaction (AREA)
  • Manufacturing & Machinery (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Multiple Motors (AREA)

Abstract

一种直线电机与两个旋转电机的同步控制方法。本发明涉及一种直线电机与两个旋转电机的同步控制方法。所述控制方法包括以下六个步骤，步骤一：将运动控制卡***初始化；步骤二：向初始化后的运动控制卡***内输入用来控制两个旋转电机的旋转角度参数；所述两个旋转电机分别是定旋转电机与动旋转电机，所述定旋转电机固定在台体上，定旋转电机的转子通过旋转电机连接杆与动旋转电机的转子刚性连接，所述动旋转电机的转子通过水平方向可伸缩线缆与直线电机连接，所述直线电机在直线电机导轨上运动，所述直线电机导轨安装在台体的左侧边。本发明用于直线电机与旋转电机的同步控制。

Description

一种直线电机与两个旋转电机的同步控制方法
技术领域：
本发明涉及一种直线电机与两个旋转电机的同步控制方法。
背景技术：
随着工业技术的发展，各种电机在生产和生活中应用愈发广泛，在工业生产中，直线电机与旋转电机的使用占据了绝大多数应用范围。在复杂的工业生产***中，无法单纯使用直线电机或旋转电机，而是需要直线电机与旋转电机配合使用。当直线电机与旋转电机配合使用时，应用单纯的直线电机或旋转电机的控制方法无法实现二者间的同步控制，会导致电机与台体相撞或者拉扯线缆等问题。
发明内容：
本发明的目的是提供一种直线电机与两个旋转电机的同步控制方法，本发明通过同一位置解算结果同时规划直线电机与旋转电机的运动轨迹，协调二者同步运动，实现了直线电机与旋转电机的同步控制，解决了旋转电机与直线电机采用传统非同步方法控制而导致的电机与台体相撞和拉扯线缆等问题。
上述的目的通过以下的技术方案实现：
一种直线电机与两个旋转电机的同步控制方法，所述控制方法包括以下六个步骤，
步骤一：将运动控制卡***初始化；
步骤二：向初始化后的运动控制卡***内输入用来控制两个旋转电机的旋转角度参数；所述两个旋转电机分别是定旋转电机与动旋转电机，所述定旋转电机固定在台体上，定旋转电机的转子通过旋转电机连接杆与动旋转电机的转子刚性连接，所述动旋转电机的转子通过水平方向可伸缩线缆与直线电机连接，所述直线电机在直线电机导轨上运动，所述直线电机导轨安装在台体的左侧边；
步骤三：利用双速旋转变压器及其角位变送器采集定旋转电机角度数据、绝对式圆光栅采集动旋转电机角度数据、增量式直线光栅采集直线电机在导轨上的位置数据，将传感器采集到的两个旋转电机的旋转角度数据以及直线电机在直线电机导轨上的位置数据均输入所述运动控制卡***进行数据转换，并实时读取两个旋转电机旋转角度数据及直线电机位置数据；
步骤四：根据读取的两个旋转电机旋转角度数据判断两个旋转电机的转子是否按照运动控制卡***输入的旋转角度参数来运动，如果是，则结束程序；如若不是，则运动控制卡***依据数学模型S＝Rg(1-cos(θgπ/180))来对两个旋转电机的旋转角度以及直线电机位置进行解算；
步骤五：运动控制卡***依据解算结果同时对直线电机及两个旋转电机进行运动轨迹规划；
步骤六：依据运动轨迹规划结果对直线电机及两个旋转电机进行驱动输出控制，并依次重复步骤三～步骤五，直到直线电机与两个旋转电机按照给定参数运动到规定位置为止。
所述的一种直线电机与两个旋转电机的同步控制方法，步骤五中，所述动旋转电机旋转角度运动轨迹为以定旋转电机定子为圆心，以旋转电机连接杆为半径，做圆周运动。
所述的一种直线电机与两个旋转电机的同步控制方法，当动旋转电机的旋转角度为90°时，动旋转电机的定子一外侧面与直线电机导轨的一侧面对齐。
所述一种直线电机与两个旋转电机的同步控制方法，步骤五中，所述数学模型具体公式为S＝Rg(1-cos(θgπ/180))，其中S为所述直线电机位置，R为所述动旋转电机中心运动半径，θ为所述两个旋转电机旋转角度。
有益效果：
1.本发明的控制策略上采用同步控制，在每个控制周期内对被控直线电机与旋转电机位置实时解算，并依据解算结果同时给出被控直线电机与旋转电机的运动规划轨迹，确保了电机控制的同步性。
2.本发明的每个控制周期内实时规划运动轨迹，不必开辟专用存储空间存储运动轨迹，减小了硬件存储资源的消耗。
3.本发明的通过同一位置解算结果同时规划直线电机与旋转电机的运动轨迹，协调二者同步运动。
附图说明：
附图1是本发明的框架示意图。
附图2是本发明的运动示意图。
附图3是本发明的动旋转电机的旋转角度为90°时的运动示意图。
直线电机(1)、台体(2)、直线电机导轨(3)、动旋转电机(4)、定旋转电机(5)、水平方向可伸缩线缆(6)、旋转电机连接杆(7)、动旋转电机(4)的运动轨迹(8)。
具体实施方式：
实施例1
一种直线电机与两个旋转电机的同步控制方法，所述控制方法包括以下六个步骤，
步骤一：将运动控制卡***初始化；
步骤二：向初始化后的运动控制卡***内输入用来控制两个旋转电机的旋转角度参数；所述两个旋转电机分别是定旋转电机与动旋转电机，所述定旋转电机固定在台体上，定旋转电机的转子通过旋转电机连接杆与动旋转电机的转子刚性连接，所述动旋转电机的转子通过水平方向可伸缩线缆与直线电机连接，所述直线电机在直线电机导轨上运动，所述直线电机导轨安装在台体的左侧边；
步骤三：利用FB924V双速旋转变压器及其角位变送器采集定旋转电机角度数据、RESA绝对式圆光栅采集动旋转电机角度数据、T1000-50A增量式直线光栅采集直线电机在导轨上的位置数据，将传感器采集到的两个旋转电机的旋转角度数据以及直线电机在直线电机导轨上的位置数据均输入所述运动控制卡***进行数据转换，并实时读取两个旋转电机旋转角度数据及直线电机位置数据；
步骤四：根据读取的两个旋转电机旋转角度数据判断两个旋转电机的转子是否按照运动控制卡***输入的旋转角度参数来运动，如果是，则结束程序；如若不是，则运动控制卡***依据数学模型S＝Rg(1-cos(θgπ/180))来对两个旋转电机的旋转角度以及直线电机位置进行解算；
步骤五：运动控制卡***依据解算结果同时对直线电机及两个旋转电机进行运动轨迹规划；
步骤六：依据运动轨迹规划结果对直线电机及两个旋转电机进行驱动输出控制，并依次重复步骤三～步骤五，直到直线电机与两个旋转电机按照给定参数运动到规定位置为止。
实施例2
实施例1所述的一种直线电机与两个旋转电机的同步控制方法，步骤五中，所述动旋转电机旋转角度运动轨迹为以定旋转电机定子为圆心，以旋转电机连接杆为半径，做圆周运动。
实施例3
实施例1所述的一种直线电机与两个旋转电机的同步控制方法，当动旋转电机的旋转角度为90°时，动旋转电机的定子一外侧面与直线电机导轨的一侧面对齐。
实施例4
实施例1所述一种直线电机与两个旋转电机的同步控制方法，步骤五中，所述数学模型具体公式为S＝Rg(1-cos(θgπ/180))，其中S为所述直线电机位置，R为所述动旋转电机中心运动半径，θ为所述两个旋转电机旋转角度。
直线电机按直线电机导轨方向运动，直线电机与动旋转电机之间有水平方向可伸缩线缆相连，该线缆只可水平伸缩，直线电机跟随两个旋转电机同步运动，运动过程中，如附图3中动旋转电机定子在惯性系中不发生偏转；通过数学建模及分析，可得到直线电机在每个控制周期内需要运动到的位置S与定旋转电机旋转角度θ之间的数学关系为：S＝Rg(1-cos(θgπ/180))。
当然，上述说明并非是对本发明的限制，本发明也并不仅限于上述举例，本技术领域的技术人员在本发明的实质范围内所做出的变化、改型、添加或替换，也应属于本发明的保护范围。

Claims (3)

1.一种直线电机与两个旋转电机的同步控制方法，其特征是：所述控制方法包括以下六个步骤，
步骤一：将运动控制卡***初始化；
步骤二：向初始化后的运动控制卡***内输入用来控制两个旋转电机的旋转角度参数；所述两个旋转电机分别是定旋转电机与动旋转电机，所述定旋转电机固定在台体上，定旋转电机的转子通过旋转电机连接杆与动旋转电机的转子刚性连接，所述动旋转电机的转子通过水平方向可伸缩线缆与直线电机连接，所述直线电机在直线电机导轨上运动，所述直线电机导轨安装在台体的左侧边；
步骤三：利用双速旋转变压器及其角位变送器采集定旋转电机角度数据、绝对式圆光栅采集动旋转电机角度数据、增量式直线光栅采集直线电机在导轨上的位置数据，将采集到的两个旋转电机的旋转角度数据以及直线电机在直线电机导轨上的位置数据均输入所述运动控制卡***进行数据转换，并实时读取两个旋转电机旋转角度数据及直线电机位置数据；
步骤四：根据读取的两个旋转电机旋转角度数据判断两个旋转电机的转子是否按照运动控制卡***输入的旋转角度参数来运动，如果是，则结束程序；如若不是，则运动控制卡***依据数学模型来对两个旋转电机的旋转角度以及直线电机位置进行解算；
步骤五：运动控制卡***依据解算结果同时对直线电机及两个旋转电机进行运动轨迹规划；
步骤六：依据运动轨迹规划结果对直线电机及两个旋转电机进行驱动输出控制，并依次重复步骤三~步骤五，直到直线电机与两个旋转电机按照给定参数运动到规定位置为止。
2.根据权利要求1所述的一种直线电机与两个旋转电机的同步控制方法，其特征是：步骤五中，所述动旋转电机运动轨迹为以定旋转电机定子为圆心，以旋转电机连接杆为半径，做圆周运动。
3.根据权利要求1所述的一种直线电机与两个旋转电机的同步控制方法，其特征是：当动旋转电机的旋转角度为90°时，动旋转电机的定子一外侧面与直线电机导轨的一侧面对齐。
CN201510405398.1A 2015-07-11 2015-07-11 一种直线电机与两个旋转电机的同步控制方法 Active CN105116843B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510405398.1A CN105116843B (zh) 2015-07-11 2015-07-11 一种直线电机与两个旋转电机的同步控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510405398.1A CN105116843B (zh) 2015-07-11 2015-07-11 一种直线电机与两个旋转电机的同步控制方法

Publications (2)

Publication Number Publication Date
CN105116843A CN105116843A (zh) 2015-12-02
CN105116843B true CN105116843B (zh) 2017-10-27

Family

ID=54664861

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510405398.1A Active CN105116843B (zh) 2015-07-11 2015-07-11 一种直线电机与两个旋转电机的同步控制方法

Country Status (1)

Country Link
CN (1) CN105116843B (zh)

Families Citing this family (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113029235B (zh) * 2021-02-25 2021-09-10 哈尔滨工业大学 小行程纳米级运动台及热相关滞回数据测量方法

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101917160A (zh) * 2010-09-12 2010-12-15 上海英迈吉东影图像设备有限公司 安全检查用螺旋ct同步控制方法及***
CN102362425A (zh) * 2009-03-25 2012-02-22 三菱电机株式会社 旋转电机的控制装置
CN103901734A (zh) * 2012-12-28 2014-07-02 上海微电子装备有限公司 一种工件台线缆装置
CN103986388A (zh) * 2013-02-08 2014-08-13 株式会社电装 旋转电机驱动***

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US8294406B2 (en) * 2009-04-06 2012-10-23 Bhargav Ishwarlal Gajjar Parallel kinematics micro-positioning system

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102362425A (zh) * 2009-03-25 2012-02-22 三菱电机株式会社 旋转电机的控制装置
CN101917160A (zh) * 2010-09-12 2010-12-15 上海英迈吉东影图像设备有限公司 安全检查用螺旋ct同步控制方法及***
CN103901734A (zh) * 2012-12-28 2014-07-02 上海微电子装备有限公司 一种工件台线缆装置
CN103986388A (zh) * 2013-02-08 2014-08-13 株式会社电装 旋转电机驱动***

Also Published As

Publication number Publication date
CN105116843A (zh) 2015-12-02

Similar Documents

Publication Publication Date Title
CN107073708A (zh) 用于时基并行机器人操作的***和方法
CN106794580A (zh) 用于指令机器人操作的***和方法
CN105487462B (zh) 一种plc运动控制模块功能验证设备与验证方法
CN102566574A (zh) 一种基于激光传感的机器人轨迹生成方法及装置
CN103310038A (zh) 一种旋转导向执行机构的虚机实电仿真***及仿真方法
CN103587719A (zh) 平板件的全自动钻铆定位方法
CN105116843B (zh) 一种直线电机与两个旋转电机的同步控制方法
CN203003897U (zh) 一种车轮轮辐三轴数控码料机械手
CN103713577B (zh) 并进/旋转误差修正量生成装置
CN107139193A (zh) 直接驱动的冗余平面并联机构控制装置及方法
CN201674333U (zh) 单电机单轴不同位移转动装置
CN108472808A (zh) 多个机器人的同步
CN104935218B (zh) 一种双旋转电机***的主从控制方法
CN207656563U (zh) 一种定位治具
CN207529208U (zh) 基于cad辅助的极坐标控制***
CN105759604B (zh) 一种双核伺服驱动***及伺服电机在线建模方法
CN104361791A (zh) 一种科氏加速度演示仪
CN104268348B (zh) 基于Intouch的可视化物流监控***及其实现方法
CN107553476A (zh) 基于cad辅助的双极坐标控制***及实现方法
CN105423997B (zh) 垂直平面驱动经纬仪
CN106940555B (zh) 可编程逻辑控制器、基于plc的运动控制方法
CN104438915B (zh) 一种基于虚拟角度的伺服压力机送料控制方法
CN105500373A (zh) 一种机器人手臂控制***
CN104281089B (zh) 四轴数控机床及其刻字方法
CN203969452U (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