CN104518710B - 一种多轴电机同步控制方法及多轴电机同步控制系统 - Google Patents
一种多轴电机同步控制方法及多轴电机同步控制系统 Download PDFInfo
- Publication number
- CN104518710B CN104518710B CN201310451648.6A CN201310451648A CN104518710B CN 104518710 B CN104518710 B CN 104518710B CN 201310451648 A CN201310451648 A CN 201310451648A CN 104518710 B CN104518710 B CN 104518710B
- Authority
- CN
- China
- Prior art keywords
- motor
- motion controller
- industrial computer
- correspondence
- motion
- 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.)
- Expired - Fee Related
Links
Abstract
本发明公开了一种多轴电机同步控制方法及多轴电机同步控制系统，工控机将机器人的运动轨迹转换为对应多个电机的运动目标轨迹，然后工控机通过CAN总线将各电机的运动目标轨迹传输至对应运动控制器，所述对应运动控制器控制对应电机运动，使多个电机分别按照各自的运动目标轨迹同时运动。采用目标点与对应的时间点共同输出的方式，实现了即使运动控制器接受到目标轨迹的时间不一致，也能在相同时间点驱动工业机器人到达预定目标点，解决了工业机器人内多轴电机即独立运行又保持同步的技术问题，实现了多轴电机的精确同步，并且由于采用软件时间同步的方式，不需要增加硬件成本，就能达到电机精同步的目的，大幅度降低了工业机器人升级、改造的成本。
Description
技术领域
本发明涉及多轴机器人领域，尤其涉及一种多轴电机同步控制方法及多轴电机同步控制系统。
背景技术
多轴电机同步技术在机器人和机床控制领域有着广泛的应用。过去的电机精同步方法主要是针对多轴电机的运动规律一致的情况。多数将电机分为主轴和副轴，同步方法从根本上说就是使副轴的电机跟踪主轴电机。但是随着机器人尤其是工业机器人的应用越来越广泛，对于其要求也是逐渐苛刻。要求工业机器人的各个轴之间能够实现精确的同步。这里的同步采用跟踪的方式是没办法解决的，因为各个轴之间没有主副关系，都是相对相互独立的，运动规律也各不相同。本专利就是针对这一背景而提出的。
现有技术中采用通过主轴电机带动多个副轴电机的方式，通过将主轴电机与多个副轴电机的速度引入误差运算部，计算出副轴电机相对于主轴电机的速度偏差。将该速度偏差引入第n个补偿控制部，完成偏差补偿，补偿值最后送到第n个副轴电机的驱动电源部，从而使得副轴电机能够跟随主轴电机，完成电机同步。这种同步方式采用速度偏差反馈的方式完成主、副轴电机的速度同步，可是在多轴工业机器人领域，各个轴之间的同步并不是简单的跟随，而是相对独立的。每个轴都有自己的规划运动路径，因此上述的电机同步方法无法解决工业机器人内多轴电机即独立运行又要保持同步的技术问题。
发明内容
鉴于上述现有技术的不足，本发明的目的在于提供一种多轴电机同步控制方法及多轴电机同步控制系统，实现多轴电机即独立运行又保持同步的目的。
为解决上述技术问题，本发明方案包括：
一种多轴电机同步控制方法，其包括以下步骤：
工控机将机器人的运动轨迹转换为对应多个电机的运动目标轨迹，然后工控机通过CAN总线将各电机的运动目标轨迹传输至对应运动控制器，所述对应运动控制器控制对应电机运动，使多个电机分别按照各自的运动目标轨迹同时运动。
所述运动目标轨迹包括对应电机的运动终点与运动时间点。
上述步骤还包括使运动控制器与工控机的时间基准实现同步的方法，其包括以下步骤：所述工控机在第一时间点先向需同步的运动控制器发送一个同步信息，对应运动控制器接收到所述同步信息后记录下自身收到该同步信息的第二时间点；所述工控机接着向对应运动控制器发送一个时间信息，所述时间信息中包含工控机发送上一个同步信息的第一时间点，对应运动控制器接收到所述第一时间点后，将第一时间点和第二时间点相减，计算出对应运动控制器与所述工控机之间的时间偏差值。
上述步骤还包括：所述工控机向多个电机的运动控制器发出运行指令时，各电机的运动控制器根据对应时间偏差值调整对应电机的运动时间，使每个电机根据所述工控机的指令，基于同一时间标准同步运行。
上述步骤还包括：所述工控机每次发出所述运行指令，则重新确定每个运动控制器对应的时间偏差值。
一种运行如上所述多轴电机同步控制方法的多轴电机同步控制系统，其包括工控机，所述工控机通过CAN总线与多个运动控制器通信连接，每个运动控制器内均设置有一用于保持运动控制器与所述工控机同步的计时变量模块，每个运动控制器对应连接一个电机。
本发明提供的一种多轴电机同步控制方法及多轴电机同步控制系统，采用目标点与其对应的时间点共同输出的方式，实现了即使运动控制器接受到目标轨迹的时间不一致，也能在相同时间点驱动工业机器人到达预定目标点，也就是说解决了工业机器人内多轴电机即能独立运行又能保持同步的技术问题，实现了多轴电机的精确同步，并且由于采用软件时间同步的方式，不需要增加硬件成本，就能达到电机精同步的目的，大幅度降低了工业机器人升级、改造的成本。
附图说明
图1是本发明中多轴电机同步控制系统的框架结构示意图；
图2是本发明中多轴电机同步控制方法的原理示意图；
图3是本发明中确定对应机器人运动时间点的流程示意图。
具体实施方式
本发明提供了一种多轴电机同步控制方法及多轴电机同步控制系统，为使本发明的目的、技术方案及效果更加清楚、明确，以下对本发明进一步详细说明。应当理解，此处所描述的具体实施例仅仅用以解释本发明，并不用于限定本发明。
本发明提供了一种多轴电机同步控制方法，结合图1所示，其包括以下步骤：
工控机将机器人的运动轨迹转换为对应多个电机的运动目标轨迹，然后工控机通过CAN总线将各电机的运动目标轨迹传输至对应运动控制器，所述对应运动控制器控制对应电机运动，使多个电机分别按照各自的运动目标轨迹同时运动，使机器人流畅地完成动作。
具体的，所述运动目标轨迹包括对应电机的运动终点与运动时间点。
如图2所示的，上述步骤还包括使运动控制器与工控机的时间基准实现同步的方法，具体包括：
所述工控机在第一时间点t0先向需同步的运动控制器发送一个同步信息，对应运动控制器接收到所述同步信息后记录下自身受到该同步信息的第二时间点t0+differ；接着，工控机向对应运动控制器发送一个时间信息，所述时间信息中包含工控机发送上一个同步信息的第一时间点t0。对应运动控制器接收到所述第一时间点t0后，将第一时间点t0和第二时间点t0+differ相减，即可计算出对应运动控制器与所述工控机之间的时间偏差值differ。
更具体的，在所述工控机和每个运动控制器中都预先设计了一个时间戳变量，该时间戳变量定时将计数值加1，相当于各自的时间基准。如图2和图3所示，首先所述工控机向对应运动控制器发送一个同步信息，对应运动控制器接收到该同步信息后，记录下对应运动控制器当时的时间戳为t0+differ。
接着所述工控机再次发送时间信息，所述时间信息携带所述工控机的发送时间戳t0。由CAN总线的特性可知：发送方的发送结束时间与接受方的接受时间是同一个时间，所以可以不考虑信息的发送延时。将对应运动控制器记录的时间戳t0+differ减去所述时间信息携带的工控机的发送时间戳t0，可以得到所述工控机和对应运动控制器之间的时间偏差值differ。通过将运动控制器中的时间戳变量减去该偏差differ，即可完成所述工控机和对应运动控制器的时间同步。
通过CAN总线与工控机连接的每个运动控制器分别对应有一个时间偏差值differ，均可以通过以上方法得出，进而实现多个运动控制器与工控机在时间基准上的同步。
进一步地，所述工控机向多个电机的运动控制器发出运行指令时，各电机的运动控制器根据对应时间偏差值调整对应电机的运动时间，使每个电机根据所述工控机的指令，基于同一时间标准同步运行。并且所述工控机每次发出所述运行指令，则重新确定每个运动控制器对应的时间偏差值，保证了所述工控机与多个运动控制器在任何时刻都保持同步。
本发明还提供了一种多轴电机同步控制系统，如图1所示的，其包括工控机，并且所述工控机通过CAN总线与多个运动控制器通信连接，每个运动控制器内均设置有一用于保持运动控制器与所述工控机同步的计时变量模块，每个运动控制器对应连接一个电机。各运动控制器通过所述计时变量模块来计算所述工控机与各运动控制器的时间差值，从而调整运动控制器内部计时变量，使得自身的计时变量与工控机的计时变量相等，达到各电机的运动时间同步的效果，从而实现了多轴电机即独立运行又保持同步的目的。
以上所述实施例仅表达了本发明的几种实施方式，其描述较为具体和详细，但并不能因此而理解为对本发明专利范围的限制。应当指出的是，对于本领域的普通技术人员来说，在不脱离本发明构思的前提下，还可以做出若干变形和改进，这些都属于本发明的保护范围。因此，本发明专利的保护范围应以所附权利要求为准。
Claims (4)
1.一种多轴电机同步控制方法，其特征在于，包括以下步骤：
工控机将机器人的运动轨迹转换为对应多个电机的运动目标轨迹，然后工控机通过CAN总线将各电机的运动目标轨迹传输至对应运动控制器，所述对应运动控制器控制对应电机运动，使多个电机分别按照各自的运动目标轨迹同时运动，所述运动目标轨迹包括对应电机的运动终点与运动时间点；
上述步骤还包括使运动控制器与工控机的时间基准实现同步的方法，其包括以下步骤：所述工控机在第一时间点先向需同步的运动控制器发送一个同步信息，对应运动控制器接收到所述同步信息后记录下自身收到该同步信息的第二时间点；所述工控机接着向对应运动控制器发送一个时间信息，所述时间信息中包含工控机发送上一个同步信息的第一时间点，对应运动控制器接收到所述第一时间点后，将第一时间点和第二时间点相减，计算出对应运动控制器与所述工控机之间的时间偏差值。
2.根据权利要求1所述的多轴电机同步控制方法，其特征在于，所述使运动控制器与工控机的时间基准实现同步的方法还包括：所述工控机向多个电机的运动控制器发出运行指令时，各电机的运动控制器根据对应时间偏差值调整对应电机的运动时间，使每个电机根据所述工控机的指令，基于同一时间标准同步运行。
3.根据权利要求2所述的多轴电机同步控制方法，其特征在于，所述使运动控制器与工控机的时间基准实现同步的方法还包括：所述工控机每次发出所述运行指令，则重新确定每个运动控制器对应的时间偏差值。
4.一种运行如权利要求1至3任一所述多轴电机同步控制方法的多轴电机同步控制系统，其包括工控机，其特征在于，所述工控机通过CAN总线与多个运动控制器通信连接，每个运动控制器内均设置有一用于保持运动控制器与所述工控机同步的计时变量模块，每个运动控制器对应连接一个电机。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310451648.6A CN104518710B (zh) | 2013-09-28 | 2013-09-28 | 一种多轴电机同步控制方法及多轴电机同步控制系统 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201310451648.6A CN104518710B (zh) | 2013-09-28 | 2013-09-28 | 一种多轴电机同步控制方法及多轴电机同步控制系统 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN104518710A CN104518710A (zh) | 2015-04-15 |
| CN104518710B true CN104518710B (zh) | 2017-03-22 |
Family
ID=52793557
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201310451648.6A Expired - Fee Related CN104518710B (zh) | 2013-09-28 | 2013-09-28 | 一种多轴电机同步控制方法及多轴电机同步控制系统 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN104518710B (zh) |
Families Citing this family (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN106712589B (zh) * | 2015-07-23 | 2019-03-29 | 北京宝沃汽车有限公司 | 一种用于匹配电机同步控制周期与驱动周期的方法和装置 |
| US9692336B2 (en) * | 2015-10-09 | 2017-06-27 | Texas Instruments Incoporated | Asynchronous state estimation and control in a field-oriented control architecture |
| CN105610553A (zh) * | 2016-01-04 | 2016-05-25 | 杭州亚美利嘉科技有限公司 | 机器人终端与服务器指令同步的控制方法、装置及系统 |
| CN105610536B (zh) * | 2016-01-04 | 2018-09-07 | 杭州亚美利嘉科技有限公司 | 一种机器人的时间同步方法及系统 |
| CN109032081B (zh) * | 2018-08-10 | 2019-10-01 | 山东易码智能科技股份有限公司 | 基于s曲线加减速的多轴机器人点位同步控制方法及系统 |
| CN114280928A (zh) * | 2021-12-01 | 2022-04-05 | 大族激光科技产业集团股份有限公司 | 控制物体运动的方法、装置、终端设备及存储介质 |
Family Cites Families (4)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US7148635B1 (en) * | 2005-09-21 | 2006-12-12 | Rockwell Automation Technologies, Inc. | Motor drive with synchronized timing |
| CN101369148B (zh) * | 2008-09-28 | 2010-09-29 | 西北工业大学 | 基于dsp的多轴交流电机同步伺服控制装置及其方法 |
| CN103151835B (zh) * | 2013-02-07 | 2015-03-11 | 航天科工深圳（集团）有限公司 | 一种分布式dtu的采样同步方法和装置 |
| CN103236810B (zh) * | 2013-05-20 | 2016-06-29 | 江苏凯隆电器有限公司 | 智能电机控制保护系统 |
-
2013
- 2013-09-28 CN CN201310451648.6A patent/CN104518710B/zh not_active Expired - Fee Related
Also Published As
| Publication number | Publication date |
|---|---|
| CN104518710A (zh) | 2015-04-15 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN104518710B (zh) | 一种多轴电机同步控制方法及多轴电机同步控制系统 | |
| CN102086893B (zh) | 多轴液压同步控制系统、方法及设备 | |
| CN108638066A (zh) | 一种用于机器人的传送带同步跟踪的装置、方法及系统 | |
| CN103737592A (zh) | 一种机械手精确控制系统及其方法 | |
| CN104467556A (zh) | 自动化冲压线冲压设备的同步控制系统和控制方法 | |
| RU2007130449A (ru) | Установка для формирования металлического контейнера, содержащая одно или более устройств с электронной координацией для выполнения операций локальной и/или протяженной деформации металлических контейнеров | |
| CN103490678A (zh) | 主从机同步控制方法及系统 | |
| CN108608463A (zh) | 工业机器人传送带动态跟踪方法 | |
| CN103488126A (zh) | 多轴运动控制系统开发平台 | |
| CN104155913A (zh) | 绗缝机双轴同步控制方法及其系统 | |
| CN102183940A (zh) | 大型魔球多轴同步控制系统、方法及魔球 | |
| CN103441711B (zh) | 一种实现平面运动的伺服或步进电机控制系统及控制方法 | |
| CN101518937A (zh) | 电动射出机的伺服马达控制装置 | |
| CN102650862A (zh) | 可编程逻辑控制器的电子凸轮控制系统及方法 | |
| CN109955247B (zh) | 多机器人自主控制系统 | |
| US20230131842A1 (en) | Multi-axis servo control system | |
| CN203660941U (zh) | 抗传动轴间隙干扰的全闭环控制装置 | |
| CN102520735B (zh) | 一种抑制单杆跟踪零位漂移的有效方法 | |
| CN206992873U (zh) | 一种丝杠传动线性运动模组 | |
| CN203759483U (zh) | 基于plc的翅片座运动控制系统 | |
| CN205104142U (zh) | 一种单轴自动跟随控制系统实训装置 | |
| WO2013054179A3 (en) | Method to command and control the electric motor of an automation unit and connected system | |
| CN203095049U (zh) | 带式输送机随机控制装置 | |
| CN203554338U (zh) | 一种实现平面运动的伺服或步进电机控制系统 | |
| JP2018018131A (ja) | モーション制御システム |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| C06 | Publication | ||
| PB01 | Publication | ||
| C10 | Entry into substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| ASS | Succession or assignment of patent right |
Owner name: SHENYANG XINSONG SMART DRIVER CO., LTD. Free format text: FORMER OWNER: SHENYANG XINSONG ROBERT AUTOMATION CO., LTD. Effective date: 20150521 |
|
| C41 | Transfer of patent application or patent right or utility model | ||
| TA01 | Transfer of patent application right |
Effective date of registration: 20150521 Address after: Hunnan New District Jinhui street in Shenyang of Liaoning province 110168 city 16-1 No. Applicant after: SHENYANG SIASUN INTELLIGENT DRIVE CO.,LTD. Address before: Hunnan New District Jinhui street in Shenyang of Liaoning province 110168 City No. 16 Applicant before: SHENYANG SIASUN ROBOT & AUTOMATION Co.,Ltd. |
|
| C14 | Grant of patent or utility model | ||
| GR01 | Patent grant | ||
| CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170322 Termination date: 20210928 |
|
| CF01 | Termination of patent right due to non-payment of annual fee |