CN114939792B - 一种五轴头c轴旋转角度限位方法 - Google Patents
一种五轴头c轴旋转角度限位方法 Download PDFInfo
- Publication number
- CN114939792B CN114939792B CN202210873850.7A CN202210873850A CN114939792B CN 114939792 B CN114939792 B CN 114939792B CN 202210873850 A CN202210873850 A CN 202210873850A CN 114939792 B CN114939792 B CN 114939792B
- Authority
- CN
- China
- Prior art keywords
- axis
- shaft
- clockwise
- anticlockwise
- angle
- 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
Links
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B23—MACHINE TOOLS; METAL-WORKING NOT OTHERWISE PROVIDED FOR
- B23Q—DETAILS, COMPONENTS, OR ACCESSORIES FOR MACHINE TOOLS, e.g. ARRANGEMENTS FOR COPYING OR CONTROLLING; MACHINE TOOLS IN GENERAL CHARACTERISED BY THE CONSTRUCTION OF PARTICULAR DETAILS OR COMPONENTS; COMBINATIONS OR ASSOCIATIONS OF METAL-WORKING MACHINES, NOT DIRECTED TO A PARTICULAR RESULT
- B23Q1/00—Members which are comprised in the general build-up of a form of machine, particularly relatively large fixed members
- B23Q1/25—Movable or adjustable work or tool supports
- B23Q1/26—Movable or adjustable work or tool supports characterised by constructional features relating to the co-operation of relatively movable members; Means for preventing relative movement of such members
Abstract
本发明属于五轴头C轴旋转控制技术领域，涉及一种五轴头C轴旋转角度限位方法，通过设置逆时针限位开关及逆时针限位触点、顺时针限位开关及顺时针限位触点和重叠区域判断开关及重叠区域判断触点，并定义旋转方向常数K，相应限位触点触发限位接近开关信号，对旋转方向常数K赋值，并有条件屏蔽限位信号使能。本发明从机械和电气控制综合角度，通过合理设置限位开关和触点位置，根据旋转方向常数K的赋值情况和限位开关触发情况，实现五轴头C轴的角度限位控制。
Description
技术领域
本发明属于五轴头C轴旋转控制技术领域，涉及一种五轴头C轴旋转角度限位方法。
背景技术
五轴头是五轴机床的关键功能部件，C轴需要360°旋转，C轴内部的线缆和管路众多，五轴头C轴旋转时内部线缆及管路运动复杂，C轴旋转角度过大或者旋转失控会损坏内部线缆和管路甚至造成安全事故，所以亟需这一种控制方法对五轴机床五轴头的C轴进行旋转角度限位控制。
发明内容
为解决上述技术问题，本发明的目的是提供一种五轴头C轴旋转角度限位方法，通过合理设置限位开关和触点位置，根据旋转方向常数K的赋值情况和限位开关触发情况，即可实现五轴头C轴的角度限位控制。
本发明提供一种五轴头C轴旋转角度限位方法，包括如下步骤：
步骤1：在C轴固定壳上设置逆时针限位开关、顺时针限位开关和重叠区域判断开关，同时在C轴上设置逆时针限位触点、顺时针限位触点和重叠区域判断触点；
步骤2：定义旋转方向常数K，当C轴顺时针进入到角度重叠区时，将旋转方向常数K赋值为“1”；当C轴逆时针进入角度重叠区时，将旋转方向常数K赋值为“0”；
步骤3：判断C轴当前所处的角度位置，即确定C轴位于角度重叠区或角度非重叠区，如果当前C轴处于角度非重叠区内，则执行步骤4，否则执行步骤7；
步骤4：如果当前C轴处于角度非重叠区内，判断C轴的旋转方向，当C轴顺时针旋转时执行步骤5，当C轴逆时针旋转时执行步骤6；
步骤5：当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，控制C轴停止旋转；
步骤6：当顺时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽顺时针触发信号，继续旋转当逆时针限位开关触发时，控制系统发出C轴逆时针限位指令，控制C轴停止旋转；
步骤7：如果当前C轴处于角度重叠区内，判断旋转方向常数K的赋值情况，当旋转方向常数K为“1”时执行步骤8，当旋转方向常数K为“0”时执行步骤9；
步骤8：若C轴顺时针旋转，当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，C轴停止旋转；若C轴逆时针旋转，当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴停止旋转；
步骤9：若C轴逆时针旋转，当逆时针限位开关触发，控制系统发出C轴逆时针限位指令，控制C轴停止旋转；若C轴顺时针旋转，顺时针限位开关触时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽顺时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴停止旋转。
在本发明的五轴头C轴旋转角度限位方法中，所述步骤1具体为：以C轴上的绝对值角度编码器0度点为C轴的机械零点，逆时针限位开关设置在190度的位置，顺时针限位开关设置在170度的位置，重叠区域判断开关在210度的位置；
逆时针限位触点和顺时针限位触点设置在同一角度位置，逆时针限位触点设置在顺时针限位触点上方，逆时针限位触点与C轴轴心的距离大于顺时针限位触点与C轴轴心的距离；
重叠区域判断触点设置在所述角度重叠区，重叠区域判断触点的感应范围是20度，重叠区域判断触点中线与逆时针限位触点的夹角为20度；逆时针限位开关和顺时针限位开关分别位于角度重叠区的两侧边界线上。
在本发明的五轴头C轴旋转角度限位方法中，所述步骤3中当重叠区域判断开关触发时，则C轴位于角度重叠区内。
在本发明的五轴头C轴旋转角度限位方法中，当C轴顺时针旋转时，角度增量为负；当C轴逆时针旋转时，角度增量为正。
五轴头是中、大规格五轴联动加工中心的核心功能部件，属于典型的“卡脖子”产品。本发明从机械和电气控制综合角度提出一种新方法，解决了五轴头C轴角度限位问题，其原理清晰、实现方法简单，硬件方面仅需增设3限位开关和相应触点，成本低。本发明通过合理设置限位开关和触点位置，根据旋转方向常数K的赋值情况和限位开关触发情况，即可实现五轴头C轴的角度限位控制。本发明的五轴头C轴旋转角度限位方法可靠性高，保证了五轴头C轴运动的可靠性。
附图说明
图1是开关及其触点的布置示意图；
图2是C轴顺时针和逆时针旋转示意图；
图3是C轴控制时序图。
具体实施方式
本发明提供一种五轴头C轴旋转角度限位方法，包括如下步骤：
步骤1：在C轴固定壳2上设置逆时针限位开关A、顺时针限位开关B和重叠区域判断开关P，同时在C轴1上设置逆时针限位触点a、顺时针限位触点b和重叠区域判断触点p，如图1所示。
具体实施时，逆时针限位触点a和顺时针限位触点b只能触发相应的逆时针限位开关A和顺时针限位开关B，逆时针限位触点a和顺时针限位触点b触发的临界角度区域为角度重叠区，即重叠区域判断触点p可触发重叠区域判断开关P的区域。
具体实施时，以C轴1上的绝对值角度编码器0度点为C轴1的机械零点，逆时针限位开关A设置在190度的位置，顺时针限位开关B设置在170度的位置，重叠区域判断开关P在210度的位置；逆时针限位触点a和顺时针限位触点b设置在同一角度位置，逆时针限位触点a设置在顺时针限位触点b上方，逆时针限位触点a与C轴轴心的距离大于顺时针限位触点b与C轴轴心的距离；重叠区域判断触点p设置在所述角度重叠区，重叠区域判断触点p的感应范围是20度，重叠区域判断触点p的中线与逆时针限位触点a的夹角为20度；逆时针限位开关A和顺时针限位开关B分别位于角度重叠区的两侧边界线上。
步骤2：定义旋转方向常数K，当C轴1顺时针进入到角度重叠区时，将旋转方向常数K赋值为“1”；当C轴1逆时针进入角度重叠区时，将旋转方向常数K赋值为“0”；
具体实施时，机床控制系统的C轴运转控制程序自定义旋转方向常数K，根据C轴1的旋转方向，进行“0”和“1”赋值。旋转方向常数K用于控制程序对逆时针限位信号和顺时针限位信号输入是否有效的条件判断。
步骤3：判断C轴1当前所处的角度位置，即确定C轴1位于角度重叠区或角度非重叠区，如果当前C轴1处于角度非重叠区内，则执行步骤4，否则执行步骤7；
具体实施时，当重叠区域判断开关P触发时，则判定C轴1位于角度重叠区内。
步骤4：如果当前C轴1处于角度非重叠区内，判断C轴1的旋转方向，当C轴1顺时针旋转时执行步骤5，当C轴1逆时针旋转时执行步骤6；
步骤5：当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，控制C轴1停止旋转；
步骤6：当顺时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽顺时针触发信号，继续旋转当逆时针限位开关触发时，控制系统发出C轴逆时针限位指令，控制C轴1停止旋转；
步骤7：如果当前C轴1处于角度重叠区内，判断旋转方向常数K的赋值情况，当旋转方向常数K为“1”时执行步骤8，当旋转方向常数K为“0”时执行步骤9；
步骤8：若C轴1顺时针旋转，当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，C轴1停止旋转；若C轴1逆时针旋转，当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴1停止旋转；
步骤9：若C轴1逆时针旋转，当逆时针限位开关触发，控制系统发出C轴逆时针限位指令，控制C轴1停止旋转；若C轴1顺时针旋转，顺时针限位开关触时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽顺时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴1停止旋转。
具体实施时，当C轴1顺时针旋转时，角度增量为负；当C轴1逆时针旋转时，角度增量为正。图2是C轴1顺时针和逆时针旋转示意图。
如图3所示的时序图，C轴1根据控制系统指令旋转，从0度线开始旋转，分成2种情况：
第一种情况，顺时针方向旋转，在旋转至-170度值时，逆时针限位开关A被逆时针限位触点a触发，逆时针限位开关A向系统发出高电平信号，同时重叠区域判断开关P被重叠区域判断触点p触发，重叠区域判断开关P向系统发出高电平信号，旋转方向常数K被赋值为“1”。
C轴1可继续顺时针旋转，至-190度时，顺时针限位开关B被顺时针触点b触发，顺时针限位开关B向系统发出高电平信号，系统执行顺时针限位操作，C轴1停止旋转。
第二种情况，逆时针方向旋转，在旋转至170度值时，顺时针限位开关B被顺时针限位触点b触发，顺时针限位开关B向系统发出高电平信号，重叠区域判断开关P被重叠区域判断触点p触发，重叠区域判断开关P向系统发出高电平信号，旋转方向常数K被赋值为“0”。
C轴1可继续逆时针旋转，至190度时，逆时针限位开关A被逆时针限位开关a触发，逆时针限位开关A向系统发出高电平信号，系统执行逆时针限位操作，C轴1停止旋转。
本发明从机械和电气控制综合角度提出一种新方法，解决了五轴头C轴角度限位问题，其原理清晰，实现方法简单、成本低，可靠性高，保证了五轴头C轴运动的可靠性。
以上所述仅为本发明的较佳实施例，并不用以限制本发明的思想，凡在本发明的精神和原则之内，所作的任何修改、等同替换、改进等，均应包含在本发明的保护范围之内。
Claims (3)
1.一种五轴头C轴旋转角度限位方法，其特征在于，包括如下步骤：
步骤1：在C轴固定壳上设置逆时针限位开关、顺时针限位开关和重叠区域判断开关，同时在C轴上设置逆时针限位触点、顺时针限位触点和重叠区域判断触点；
步骤2：定义旋转方向常数K，当C轴顺时针进入到角度重叠区时，将旋转方向常数K赋值为“1”；当C轴逆时针进入角度重叠区时，将旋转方向常数K赋值为“0”；
步骤3：判断C轴当前所处的角度位置，即确定C轴位于角度重叠区或角度非重叠区，如果当前C轴处于角度非重叠区内，则执行步骤4，否则执行步骤7；
步骤4：如果当前C轴处于角度非重叠区内，判断C轴的旋转方向，当C轴顺时针旋转时执行步骤5，当C轴逆时针旋转时执行步骤6；
步骤5：当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，控制C轴停止旋转；
步骤6：当顺时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽顺时针触发信号，继续旋转当逆时针限位开关触发时，控制系统发出C轴逆时针限位指令，控制C轴停止旋转；
步骤7：如果当前C轴处于角度重叠区内，判断旋转方向常数K的赋值情况，当旋转方向常数K为“1”时执行步骤8，当旋转方向常数K为“0”时执行步骤9；
步骤8：若C轴顺时针旋转，当顺时针限位开关触发时，控制系统发出C轴顺时针限位指令，C轴停止旋转；若C轴逆时针旋转，当逆时针限位开关触发时，控制系统将旋转方向常数K赋值为“0”，同时屏蔽逆时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴停止旋转；
步骤9：若C轴逆时针旋转，当逆时针限位开关触发，控制系统发出C轴逆时针限位指令，控制C轴停止旋转；若C轴顺时针旋转，顺时针限位开关触时，控制系统将旋转方向常数K赋值为“1”，同时屏蔽顺时针触发信号，继续旋转当顺时针限位开关触发时，发出C轴顺时针限位指令，C轴停止旋转；
所述步骤1具体为：以C轴上的绝对值角度编码器0度点为C轴的机械零点，逆时针限位开关设置在190度的位置，顺时针限位开关设置在170度的位置，重叠区域判断开关在210度的位置；
逆时针限位触点和顺时针限位触点设置在同一角度位置，逆时针限位触点设置在顺时针限位触点上方，逆时针限位触点与C轴轴心的距离大于顺时针限位触点与C轴轴心的距离；
重叠区域判断触点设置在所述角度重叠区，重叠区域判断触点的感应范围是20度，重叠区域判断触点中线与逆时针限位触点的夹角为20度；逆时针限位开关和顺时针限位开关分别位于角度重叠区的两侧边界线上。
2.如权利要求1所述的五轴头C轴旋转角度限位方法，其特征在于，所述步骤3中当重叠区域判断开关触发时，则C轴位于角度重叠区内。
3.如权利要求1所述的五轴头C轴旋转角度限位方法，其特征在于，当C轴顺时针旋转时，角度增量为负；当C轴逆时针旋转时，角度增量为正。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210873850.7A CN114939792B (zh) | 2022-07-25 | 2022-07-25 | 一种五轴头c轴旋转角度限位方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202210873850.7A CN114939792B (zh) | 2022-07-25 | 2022-07-25 | 一种五轴头c轴旋转角度限位方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN114939792A CN114939792A (zh) | 2022-08-26 |
| CN114939792B true CN114939792B (zh) | 2022-11-01 |
Family
ID=82910350
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202210873850.7A Active CN114939792B (zh) | 2022-07-25 | 2022-07-25 | 一种五轴头c轴旋转角度限位方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN114939792B (zh) |
Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101664856A (zh) * | 2009-08-21 | 2010-03-10 | 深圳市翠涛自动化设备有限公司 | 一种带传感器的旋转轴限位装置及其限位方法 |
| CN101986232A (zh) * | 2010-09-16 | 2011-03-16 | 南京中科天文仪器有限公司 | 全圆周运动的限位方法及其设备 |
| CN103042397A (zh) * | 2012-12-27 | 2013-04-17 | 中国船舶重工集团公司第七二三研究所 | 一种转角范围不超过360°的转台电气限位机构 |
| CN103286613A (zh) * | 2013-06-17 | 2013-09-11 | 沈阳机床（集团）设计研究院有限公司 | 一种用于铣头旋转轴的螺旋型限位装置 |
| CN103536307A (zh) * | 2013-09-27 | 2014-01-29 | 北京辛耕普华医疗科技有限公司 | 用于医疗设备的旋转部件限位装置及具有其的医疗设备 |
| CN107500156A (zh) * | 2017-08-23 | 2017-12-22 | 武汉船用机械有限责任公司 | 绕桩式回转起重机的回转重叠区域的判断装置及判断方法 |
| CN108594863A (zh) * | 2018-04-03 | 2018-09-28 | 北京航天控制仪器研究所 | 一种正负180°转台的限位结构及方法 |
Family Cites Families (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US9329394B2 (en) * | 2014-01-03 | 2016-05-03 | Himax Technologies Limited | Lens module and assembling method thereof |
-
2022
- 2022-07-25 CN CN202210873850.7A patent/CN114939792B/zh active Active
Patent Citations (7)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101664856A (zh) * | 2009-08-21 | 2010-03-10 | 深圳市翠涛自动化设备有限公司 | 一种带传感器的旋转轴限位装置及其限位方法 |
| CN101986232A (zh) * | 2010-09-16 | 2011-03-16 | 南京中科天文仪器有限公司 | 全圆周运动的限位方法及其设备 |
| CN103042397A (zh) * | 2012-12-27 | 2013-04-17 | 中国船舶重工集团公司第七二三研究所 | 一种转角范围不超过360°的转台电气限位机构 |
| CN103286613A (zh) * | 2013-06-17 | 2013-09-11 | 沈阳机床（集团）设计研究院有限公司 | 一种用于铣头旋转轴的螺旋型限位装置 |
| CN103536307A (zh) * | 2013-09-27 | 2014-01-29 | 北京辛耕普华医疗科技有限公司 | 用于医疗设备的旋转部件限位装置及具有其的医疗设备 |
| CN107500156A (zh) * | 2017-08-23 | 2017-12-22 | 武汉船用机械有限责任公司 | 绕桩式回转起重机的回转重叠区域的判断装置及判断方法 |
| CN108594863A (zh) * | 2018-04-03 | 2018-09-28 | 北京航天控制仪器研究所 | 一种正负180°转台的限位结构及方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN114939792A (zh) | 2022-08-26 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN114939792B (zh) | 一种五轴头c轴旋转角度限位方法 | |
| JP2016159367A (ja) | ロボットの動作モードを自動的に切替えるロボット制御装置 | |
| CN113182681B (zh) | 一种壳盖侧缝的焊接轨迹获取方法及焊接方法 | |
| US4264848A (en) | Device for the monitored control of a stepping motor | |
| CN111176482A (zh) | 一种圆弧轨迹插补的方法 | |
| CN104267742B (zh) | 一种球机垂直原点校正方法和装置 | |
| JPH09292264A (ja) | アブソリュートエンコーダ | |
| CN208914169U (zh) | 一种可拆卸的机器人抓取结构 | |
| JP2015157332A (ja) | ロボット装置 | |
| JP2021068411A (ja) | マウス装置及びスクロールホイールモジュール | |
| KR0130450B1 (ko) | 로보트 암의 원점복귀 및 동작한계 검출방법 | |
| JPS63220999A (ja) | クランク軸制御装置 | |
| CN109917849B (zh) | 一种转台回转电气限位装置、控制方法及工程机械车 | |
| KR0126952Y1 (ko) | 로보트 팔의 원점복귀장치 | |
| CN108115670B (zh) | 机器人灵巧手手指标定装置及方法 | |
| KR0176506B1 (ko) | 로보트의 원점복귀 장치 | |
| JPS59102557A (ja) | 移動物体の位置決め装置 | |
| US20210354293A1 (en) | Robot controlling device, robot system and method of controlling robot | |
| JPH0353080B2 (zh) | ||
| KR0141822B1 (ko) | 차량회전용 턴테이블 제어방법 | |
| JPS63215399A (ja) | クランク軸制御装置 | |
| CN105500028A (zh) | 一种cnc工作台 | |
| JPS60233705A (ja) | ロボツトの安全装置 | |
| WO2023138757A1 (en) | Method and apparatus for implementing a safety configuration | |
| CN116281610A (zh) | 一种塔机限位方法、控制系统及存储介质 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant | ||
| CP01 | Change in the name or title of a patent holder | ||
| CP01 | Change in the name or title of a patent holder |
Address after: 110027 No. 1-8, 17a, Kaifa Road, Shenyang Economic and Technological Development Zone, Liaoning Province Patentee after: General Technology Group Shenyang Machine Tool Co.,Ltd. Address before: 110027 No. 1-8, 17a, Kaifa Road, Shenyang Economic and Technological Development Zone, Liaoning Province Patentee before: SHENYANG MACHINE TOOL (GROUP) CO.,LTD. |