CN103383552B - 一种任意平面圆弧插补运动控制器及其控制方法 - Google Patents
一种任意平面圆弧插补运动控制器及其控制方法 Download PDFInfo
- Publication number
- CN103383552B CN103383552B CN201210474234.0A CN201210474234A CN103383552B CN 103383552 B CN103383552 B CN 103383552B CN 201210474234 A CN201210474234 A CN 201210474234A CN 103383552 B CN103383552 B CN 103383552B
- Authority
- CN
- China
- Prior art keywords
- plane
- coordinate
- interpolated point
- circular arc
- central 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
Landscapes
- Manipulator (AREA)
- Numerical Control (AREA)
Abstract
本发明公开了一种任意平面圆弧插补运动控制器及其方法,根据空间中任意平面圆弧上已知的三个点的坐标实现任意平面圆弧插补功能。该控制方法包括以下步骤:求取这三个点所在的平面;将平面通过两次欧拉变换旋转到XY平面;计算这三个点在XY平面下的坐标;计算出圆心及半径;将圆心平移到XY平面的原点;将该圆弧分成一系列等间隔插补点;计算每个插补点的圆心角;计算出相应插补点在该XY平面下的坐标;将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。本发明的优点在于:工作可靠、实现简单,能实现高速高精度的任意平面圆弧插补功能。
Description
技术领域
本发明涉及一种控制器及其控制方法,尤其是涉及一种任意平面圆弧插补运动控制器及其控制方法。
背景技术
在运动控制领域中,任意平面圆弧插补一般采用PC计算出插补节点,然后下载到运动控制器。但该方法不能满足目前嵌入式应用的需求,为此需要开发一种简单实用的插补算法,以方便在嵌入式系统上能完成实时运算,并控制运动模块实现任意平面圆弧插补运动。
发明内容
有鉴于此,有必要提供一种实用的任意平面圆弧插补运动控制器及其控制方法。
本发明是这样实现的,一种任意平面圆弧插补运动控制器,其根据空间中任意平面圆弧上已知的三个点的坐标实现任意平面圆弧插补功能,该控制器包括:
平面方程计算单元,用于根据该已知的三个点的坐标,求取该已知的三个点所在的平面的平面方程;
XY平面转换单元,用于将该平面通过两次欧拉变换旋转到XY平面,其中,X与Y分别为坐标轴;
第一坐标换算单元,用于换算该已知的三个点在该XY平面下的坐标;
圆心与半径计算单元,用于根据该已知的三个点在该XY平面下的坐标计算出该圆弧的圆心与半径;
平移单元,用于将该圆心平移到该XY平面的原点;
插补点获取单元,用于将该圆弧分成一系列等间隔插补点;
圆心角计算单元,用于计算每个插补点的圆心角;
XY平面坐标计算单元,用于根据圆心角计算出相应插补点在该XY平面下的坐标;以及
第二坐标换算单元,用于将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。
作为上述方案的进一步改进,该圆心角满足以下公式:
θ=2×sqrt(δ/R),其中,θ代表该圆心角;sqrt表示开平方根;δ表示为该圆弧的起始点到终点用直线代替存在的最大误差;R表示为该圆弧的半径。
本发明还涉及一种任意平面圆弧插补运动控制方法,其根据空间中任意平面圆弧上已知的三个点的坐标实现任意平面圆弧插补功能,该控制方法包括以下步骤:
根据该已知的三个点的坐标,求取该已知的三个点所在的平面的平面方程;
将该平面通过两次欧拉变换旋转到XY平面,其中,X与Y分别为坐标轴;
换算该已知的三个点在该XY平面下的坐标;
根据该已知的三个点在该XY平面下的坐标计算出该圆弧的圆心与半径;
将该圆心平移到该XY平面的原点;
将该圆弧分成一系列等间隔插补点;
计算每个插补点的圆心角;
根据根据圆心角计算出相应插补点在该XY平面下的坐标;以及
将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。
作为上述方案的进一步改进,该圆心角满足以下公式:
θ=2×sqrt(δ/R),其中,θ代表该圆心角;sqrt表示开平方根;δ表示为该圆弧的起始点到终点用直线代替存在的最大误差;R表示为该半径。
本发明提供的任意平面圆弧插补运动控制器及其控制方法具有以下优点:工作可靠、实现简单,能实现高速高精度的任意平面圆弧插补功能。
附图说明
图1为本发明较佳实施方式提供的任意平面圆弧插补运动控制器的模块结构示意图。
图2为图1中任意平面圆弧插补运动控制器的每个插补点的获取原理图。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图及实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。
请一并参阅图1及图2,本发明的任意平面圆弧插补运动控制器根据空间中任意平面圆弧上已知的三个点的坐标,实现任意平面圆弧插补功能。
该控制器包括平面方程计算单元1、XY平面转换单元2、第一坐标换算单元3、圆心与半径计算单元4、平移单元5、插补点获取单元9、圆心角计算单元6、XY平面坐标计算单元7、以及第二坐标换算单元8。
平面方程计算单元1用于根据该已知的三个点的坐标,求取该已知的三个点所在的平面的平面方程;XY平面转换单元2用于将该平面通过两次欧拉变换旋转到XY平面,其中,X与Y分别为坐标轴;第一坐标换算单元3用于换算该已知的三个点在该XY平面下的坐标;圆心与半径计算单元4用于根据该已知的三个点在该XY平面下的坐标计算出该圆弧的圆心与半径R;平移单元5用于将该圆心平移到该XY平面的原点;插补点获取单元9用于将该圆弧分成一系列等间隔插补点;圆心角计算单元6用于计算每个插补点的圆心角;XY平面坐标计算单元用于根据圆心角计算出相应插补点在该XY平面下的坐标;第二坐标换算单元8用于将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。
下面,本发明的任意平面圆弧插补运动控制器的控制方法进行详细的举例说明。
假设,已知空间(x,y,z三轴两两垂直空间)中任意平面圆弧上三个点a、b、c坐标a(x1,y1,z1),b(x2,y2,z2),c(x3,y3,z3),由此将先求取这三个点a、b、c所在的平面方程Ax+By+Cz+D=0,其中,A、B、C、D均为常数,A2+B2+C2≠0,然后将这一平面通过两次欧拉变换旋转到XY平面,计算这三个点a、b、c在XY平面下的坐标得到(x1’,y1’,0),(x2’,y2’,0),(x2’,y2’,0),然后根据这三点a、b、c计算出圆心及半径R,并将圆心平移到XY平面的原点O(0,0,0)。
将该圆弧分成一系列等间隔插补点,由于为等间隔插补点,因此插补点具有规律性,如插补点d为点a、b的中分点。该圆弧的起始点a到终点b用直线代替存在最大误差δ,其最大误差δ为直线de的长度(如图2所示,点e为直线Od与直线ab的交点),由此可得:
δ=|ad|*sin(θ/2)
≈R*(θ/2)*sin(θ/2)
≈R*(θ/2)*(θ/2)
=Rθ2/4
由上述公式可得:θ=2*sqrt(δ/R)。
因此,根据θ计算出插补点d在XY平面下的坐标,然后再进行两次欧拉变换,即可计算出该插补点在任意平面下的坐标。这样,每次只需要在上一节点运动完成之前计算出下一节点坐标即可,然后调用三维直线连续插补功能,就可实现任意平面圆弧插补功能。
以上所述仅为本发明的较佳实施例而已,并不用以限制本发明,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,均应包含在本发明的保护范围之内。
Claims (2)
1.一种任意平面圆弧插补运动控制器,其根据空间中任意平面圆弧上已知的三个点的坐标实现任意平面圆弧插补功能,其特征在于:该控制器包括:
平面方程计算单元,用于根据该已知的三个点的坐标,求取该已知的三个点所在的平面的平面方程;
XY平面转换单元,用于将该平面通过两次欧拉变换旋转到XY平面,其中,X与Y分别为坐标轴;
第一坐标换算单元,用于换算该已知的三个点在该XY平面下的坐标;
圆心与半径计算单元,用于根据该已知的三个点在该XY平面下的坐标计算出该圆弧的圆心与半径;
平移单元,用于将该圆心平移到该XY平面的原点;
插补点获取单元,用于将该圆弧分成一系列等间隔插补点;
圆心角计算单元,用于计算每个插补点的圆心角,该圆心角满足以下公式:θ=2×sqrt(δ/R),其中,θ代表该圆心角;sqrt表示开平方根;δ表示为该圆弧的起始点到终点用直线代替存在的最大误差;R表示为该圆弧的半径;
XY平面坐标计算单元,用于根据圆心角计算出相应插补点在该XY平面下的坐标;以及
第二坐标换算单元,用于将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。
2.一种任意平面圆弧插补运动控制方法,其根据空间中任意平面圆弧上已知的三个点的坐标实现任意平面圆弧插补功能,其特征在于:该控制方法包括以下步骤:
根据该已知的三个点的坐标,求取该已知的三个点所在的平面的平面方程;
将该平面通过两次欧拉变换旋转到XY平面,其中,X与Y分别为坐标轴;
换算该已知的三个点在该XY平面下的坐标;
根据该已知的三个点在该XY平面下的坐标计算出该圆弧的圆心与半径;
将该圆心平移到该XY平面的原点;
将该圆弧分成一系列等间隔插补点;
计算每个插补点的圆心角,该圆心角满足以下公式:θ=2×sqrt(δ/R),其中,θ代表该圆心角;sqrt表示开平方根;δ表示为该圆弧的起始点到终点用直线代替存在的最大误差;R表示为该半径;
根据根据圆心角计算出相应插补点在该XY平面下的坐标;以及
将每个插补点在该XY平面下的坐标进行两次欧拉变换,计算出每个插补点在该任意平面下的最终坐标。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210474234.0A CN103383552B (zh) | 2012-11-21 | 2012-11-21 | 一种任意平面圆弧插补运动控制器及其控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210474234.0A CN103383552B (zh) | 2012-11-21 | 2012-11-21 | 一种任意平面圆弧插补运动控制器及其控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103383552A CN103383552A (zh) | 2013-11-06 |
CN103383552B true CN103383552B (zh) | 2015-08-26 |
Family
ID=49491376
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210474234.0A Active CN103383552B (zh) | 2012-11-21 | 2012-11-21 | 一种任意平面圆弧插补运动控制器及其控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103383552B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103676787B (zh) * | 2013-12-13 | 2016-06-22 | 大连理工计算机控制工程有限公司 | 一种用于运动控制系统的圆心模式空间圆弧插补方法 |
CN105855672B (zh) * | 2016-05-30 | 2018-07-24 | 科德数控股份有限公司 | 基于示教机器人的空间圆弧插补焊接方法 |
CN106444625B (zh) * | 2016-09-18 | 2019-03-12 | 合肥工业大学 | 一种玻璃切割机的刀头随动控制方法及其控制装置 |
CN109669396B (zh) * | 2018-12-04 | 2021-11-05 | 天津津航技术物理研究所 | 一种轴对称非球面的变间隔直线插补方法 |
CN111580453B (zh) * | 2020-05-26 | 2023-03-31 | 傲拓科技股份有限公司 | 基于plc的提高二维圆弧插补轨迹精度的实现方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101140460A (zh) * | 2006-09-06 | 2008-03-12 | 北京数码大方科技有限公司 | 用于驱动数控机床进行空间圆弧插补加工的方法和装置 |
CN102478832A (zh) * | 2010-11-22 | 2012-05-30 | 大连创达技术交易市场有限公司 | 可实现数控机床曲面加工的三坐标圆弧插补方法及装置 |
CN102608956A (zh) * | 2012-03-05 | 2012-07-25 | 浙江工业大学 | 一种基于de Boor算法的NURBS曲线自适应插补控制方法 |
JP5132842B1 (ja) * | 2011-10-27 | 2013-01-30 | 三菱電機株式会社 | 数値制御装置 |
-
2012
- 2012-11-21 CN CN201210474234.0A patent/CN103383552B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101140460A (zh) * | 2006-09-06 | 2008-03-12 | 北京数码大方科技有限公司 | 用于驱动数控机床进行空间圆弧插补加工的方法和装置 |
CN102478832A (zh) * | 2010-11-22 | 2012-05-30 | 大连创达技术交易市场有限公司 | 可实现数控机床曲面加工的三坐标圆弧插补方法及装置 |
JP5132842B1 (ja) * | 2011-10-27 | 2013-01-30 | 三菱電機株式会社 | 数値制御装置 |
CN102608956A (zh) * | 2012-03-05 | 2012-07-25 | 浙江工业大学 | 一种基于de Boor算法的NURBS曲线自适应插补控制方法 |
Non-Patent Citations (2)
Title |
---|
刀具姿态实时控制的空间圆弧插补研究;李韬等;《机械科学与技术》;20110228;第30卷(第2期);第222-225页 * |
数控系统中圆弧插补算法的改进和实现;李莉等;《控制与检测》;20091231(第7期);第61-65页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103383552A (zh) | 2013-11-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103383552B (zh) | 一种任意平面圆弧插补运动控制器及其控制方法 | |
CN106003034B (zh) | 一种主从式机器人控制系统及控制方法 | |
CN102937426B (zh) | 一种基于机器人视觉伺服的大型复杂零件测量方法 | |
CN109986564A (zh) | 工业机械臂路径规划方法 | |
CN106346478A (zh) | 机械臂的控制方法和装置 | |
CN106799745A (zh) | 一种基于协同克里金的工业机械臂精度标定方法 | |
CN103568012B (zh) | 一种弧焊机器人双平面摆弧轨迹的规划方法 | |
CN111390902B (zh) | 轨迹规划方法、轨迹规划装置、设备和存储介质 | |
CN104570735A (zh) | 一种码垛机器人弧形运动轨迹算法 | |
CN110494261B (zh) | 用于建立和保持预构建关系的方法和系统 | |
CN106060781B (zh) | 基于BIM与Zigbee技术融合的空间定位方法 | |
CN110706331A (zh) | 一种基于bim点云技术与三维扫描的施工质量控制方法 | |
CN108536146B (zh) | 基于路径和rssi的移动机器人定位充电基座的智能控制方法 | |
CN104298244A (zh) | 一种工业机器人三维实时高精度定位装置及方法 | |
CN109333537A (zh) | 一种双臂协作机器人系统的基坐标系标定方法及系统 | |
CN106840169A (zh) | 用于机器人路径规划的改进方法 | |
CN108534789A (zh) | 一种多路径定位坐标统一方法、电子设备和可读存储介质 | |
CN108646759B (zh) | 基于立体视觉的智能可拆卸移动机器人系统及控制方法 | |
CN107553485B (zh) | 一种人机交互过程中动态虚拟夹具的生成方法 | |
JP2023509088A (ja) | ロボット制御方法、制御システム及びモジュラーロボット | |
CN108582037A (zh) | 一种通过两个相机跟机器人配合实现精密贴合的方法 | |
CN104536381B (zh) | 一种用于对多轴运动控制系统测量轮廓误差的系统及方法 | |
CN204725516U (zh) | 一种适用于流水线作业的单视觉配合多机器人定位系统 | |
CN115357851A (zh) | 一种用于人机交互系统的主从端混合映射方法及其应用 | |
CN211974977U (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 | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 518000 floor 1, No.2, Changyi industrial factory, No.1, Lirong Road, Xinshi community, Dalang street, Longhua District, Shenzhen City, Guangdong Province Patentee after: Shenzhen Zhixin Precision Instrument Co.,Ltd. Address before: 518000 3rd floor, Section A, building a, Sunshine Industrial Park, No.2-3, Hezhou South Industrial Zone, Xixiang, Bao'an District, Shenzhen City, Guangdong Province Patentee before: SHENZHEN ZHIXIN PRECISION INSTRUMENT Co.,Ltd. |