CN112776341A - 一种三维打印设备中的六轴机器人的轴动作优化方法 - Google Patents

一种三维打印设备中的六轴机器人的轴动作优化方法 Download PDF

Info

Publication number
CN112776341A
CN112776341A CN202011473683.4A CN202011473683A CN112776341A CN 112776341 A CN112776341 A CN 112776341A CN 202011473683 A CN202011473683 A CN 202011473683A CN 112776341 A CN112776341 A CN 112776341A
Authority
CN
China
Prior art keywords
axis
shaft
robot
flange
optimization method
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
CN202011473683.4A
Other languages
English (en)
Other versions
CN112776341B (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.)
Shanghai Yizao Building Intelligent Engineering Co ltd
Tongji University
Original Assignee
Shanghai Yizao Building Intelligent Engineering Co ltd
Tongji University
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 Shanghai Yizao Building Intelligent Engineering Co ltd, Tongji University filed Critical Shanghai Yizao Building Intelligent Engineering Co ltd
Priority to CN202011473683.4A priority Critical patent/CN112776341B/zh
Publication of CN112776341A publication Critical patent/CN112776341A/zh
Application granted granted Critical
Publication of CN112776341B publication Critical patent/CN112776341B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
    • B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
    • B29C64/00—Additive manufacturing, i.e. manufacturing of three-dimensional [3D] objects by additive deposition, additive agglomeration or additive layering, e.g. by 3D printing, stereolithography or selective laser sintering
    • B29C64/30—Auxiliary operations or equipment
    • B29C64/386—Data acquisition or data processing for additive manufacturing
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B28—WORKING CEMENT, CLAY, OR STONE
    • B28B—SHAPING CLAY OR OTHER CERAMIC COMPOSITIONS; SHAPING SLAG; SHAPING MIXTURES CONTAINING CEMENTITIOUS MATERIAL, e.g. PLASTER
    • B28B1/00—Producing shaped prefabricated articles from the material
    • B28B1/001—Rapid manufacturing of 3D objects by additive depositing, agglomerating or laminating of material
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B29—WORKING OF PLASTICS; WORKING OF SUBSTANCES IN A PLASTIC STATE IN GENERAL
    • B29C—SHAPING OR JOINING OF PLASTICS; SHAPING OF MATERIAL IN A PLASTIC STATE, NOT OTHERWISE PROVIDED FOR; AFTER-TREATMENT OF THE SHAPED PRODUCTS, e.g. REPAIRING
    • B29C64/00—Additive manufacturing, i.e. manufacturing of three-dimensional [3D] objects by additive deposition, additive agglomeration or additive layering, e.g. by 3D printing, stereolithography or selective laser sintering
    • B29C64/30—Auxiliary operations or equipment
    • B29C64/386—Data acquisition or data processing for additive manufacturing
    • B29C64/393—Data acquisition or data processing for additive manufacturing for controlling or regulating additive manufacturing processes
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B33—ADDITIVE MANUFACTURING TECHNOLOGY
    • B33Y—ADDITIVE MANUFACTURING, i.e. MANUFACTURING OF THREE-DIMENSIONAL [3-D] OBJECTS BY ADDITIVE DEPOSITION, ADDITIVE AGGLOMERATION OR ADDITIVE LAYERING, e.g. BY 3-D PRINTING, STEREOLITHOGRAPHY OR SELECTIVE LASER SINTERING
    • B33Y50/00—Data acquisition or data processing for additive manufacturing
    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B33—ADDITIVE MANUFACTURING TECHNOLOGY
    • B33Y—ADDITIVE MANUFACTURING, i.e. MANUFACTURING OF THREE-DIMENSIONAL [3-D] OBJECTS BY ADDITIVE DEPOSITION, ADDITIVE AGGLOMERATION OR ADDITIVE LAYERING, e.g. BY 3-D PRINTING, STEREOLITHOGRAPHY OR SELECTIVE LASER SINTERING
    • B33Y50/00—Data acquisition or data processing for additive manufacturing
    • B33Y50/02—Data acquisition or data processing for additive manufacturing for controlling or regulating additive manufacturing processes
    • Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02P—CLIMATE CHANGE MITIGATION TECHNOLOGIES IN THE PRODUCTION OR PROCESSING OF GOODS
    • Y02P10/00—Technologies related to metal processing
    • Y02P10/25—Process efficiency

Landscapes

  • Engineering & Computer Science (AREA)
  • Chemical & Material Sciences (AREA)
  • Materials Engineering (AREA)
  • Manufacturing & Machinery (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • Optics & Photonics (AREA)
  • Ceramic Engineering (AREA)
  • Numerical Control (AREA)
  • Manipulator (AREA)

Abstract

本发明提供了一种三维打印设备中的六轴机器人的轴动作优化方法，包括以下步骤；步骤S1，采集待打印的3D模型的结构点阵模型数据；步骤S2，将结构点阵模型数据导入3D打印机中，步骤S3，选择需要优化的轴关节；步骤S4，将结构点阵模型数据中的待打印的目标点定义为目标原点坐标P；步骤S5，将目标原点坐标P与待优化的轴关节之间建立机械变换结构式；步骤S6，根据轴关节需求的动作角度，从机械变换结构式倒推打印目标原点坐标P的行动轨迹角度。本发明公开了一种适用于三维打印设备中的六轴机器人中的便捷、稳定的轴动作优化方法。

Description

一种三维打印设备中的六轴机器人的轴动作优化方法
技术领域
本发明涉及机械自动化控制领域，具体涉及一种三维打印设备中的六轴机器人的轴动作优化方法。
背景技术
三维打印主流按打印路径分为层级打印和空间结构打印。一般来说用abs，pla，混凝土，金属堆焊，热固性材料等。本发明在上述打印方式都可以有应用的空间。
目前机器人三维打印的主要方法是通过描述一系列的三维空间点，通过离线文件的形式传输给机器人，机器人再通过内置的反向运动学算法算出机器人自身每个轴的需要转动的度数，从而使得自身的末端工具头能够达到目标点。
在传统的六轴机器人包括驱动连接在底座的本体回旋轴A1和3D打印头之间的，驱动连接本体回旋轴A1、大臂运动轴A2、小臂运动轴A3、手腕旋转轴A4、手腕摆动轴A5、圆周转动轴A6。六轴机器人在三维打印中，对围绕TCP坐标的法向量，即3D打印头的喷口方向向量的转动并不敏感。如图1是未经过动作优化的六个关节轴在时间轴上的动作变化曲线，图2是经过动作优化后的六个关节轴在时间轴上的动作变化曲线。现有技术中，采用的方法，例如，专利：CN201811562534.8，一种基于时间分组的机械臂关节轨迹优化方法；以及专利：CN201310145357.4，一种基于遗传算法的移动机械臂轨迹规划优化方法公开的均是采用优化运动轨迹的方式，需要大量时间进行数值迭代优化，操作繁琐，实现动作的初步优化，优化效果不佳。从图1和图2的曲线变化中，对所有关节轴进行运动优化，减小不必要的运动；其中手腕旋转轴A4变换角度接近0度或等于0度。调节手腕旋转轴A4或/和圆周转动轴A6的变换状态能控制六轴机器人其他关节的运行轨迹；即手腕旋转轴A4变换角度接近0度或等于0度时六轴机器人其他关节的运行轨迹趋向于动作优化曲线。
因此，需要研发一种便捷优化六轴机器人动作的方法。通过调节局部的关节轴运动状态从而调节运动轨迹。
发明内容
本发明克服了现有技术的不足，提供了一种适用于三维打印设备中的六轴机器人中的便捷、稳定的轴动作优化方法。
为达到上述目的，本发明采用的技术方案为：一种三维打印设备中的六轴机器人的轴动作优化方法，包括3D打印机，3D打印机驱动连接有六轴机器人，所述六轴机器人一端驱动设置在3D打印机上，所述六轴机器人的另一端驱动连接有3D打印头，所述3D打印头对应所述3D打印机的打印仓。
3D打印中的轴动作优化方法包括以下步骤；
步骤S1，采集待打印的3D模型的结构点阵模型数据；
步骤S2，将结构点阵模型数据导入3D打印机中，
步骤S3，选择需要优化的轴关节；
步骤S4，将结构点阵模型数据中的待打印的目标点定义为目标原点坐标P；
步骤S5，将目标原点坐标P与待优化的轴关节之间建立机械变换结构式；
步骤S6，根据轴关节需求的动作角度，从机械变换结构式倒推打印目标原点坐标P的行动轨迹角度。
本发明一个优选的实施方案中，步骤S4中，还包括，步骤a1，将六轴机器人根部底座定义为世界坐标系；步骤a2，将结构点阵模型数据导入3D打印机，根据结构点阵模型数据和打印头的位置设定3D模型的目标原点坐标P，p＝(x,y,z)。
本发明一个优选的实施方案中，步骤S5中，还包括，步骤b1，根据目标原点坐标P定义以目标原点坐标P为原点的目标原点坐标系
Figure BDA0002836861610000021
步骤b2，旋转变换Rx是围绕P点上的3D打印头的喷口的喷涂方向旋转的旋转变换矩阵；步骤b3，定义待调节的轴关节上与3D打印头之间的相对轴关节上法兰的变换
Figure BDA0002836861610000031
Figure BDA0002836861610000032
是法兰tool与3D打印头的喷口flange之间的相对变换位置关系；步骤b4，根据机械臂的变换结构获得，机械变换结构式
Figure BDA0002836861610000033
为底座0到3D打印头的喷口flange之间的位置关系。
本发明一个优选的实施方案中，所述步骤b1中，还包括，所述目标原点坐标系
Figure BDA0002836861610000034
中；根据3D打印头的喷口的喷打方向定义目标原点坐标系为
Figure BDA0002836861610000035
Figure BDA0002836861610000036
本发明一个优选的实施方案中，步骤b2中，还包括，所述旋转变换Rx中，
Figure BDA0002836861610000037
本发明一个优选的实施方案中，步骤b3中，还包括，根据六轴机器人的tx和tz，tz为待调节的轴关节上的法兰中心与3D打印头中心轴线的法线，tx是tz位于D打印头中心轴线上的交点至3D打印头端部喷口之间直线；所述
Figure BDA0002836861610000038
为
Figure BDA0002836861610000039
本发明一个优选的实施方案中，法兰的坐标平面的Z轴的方向向量为vflange，vflange在世界坐标系的X轴和Y轴上的投影为vfx和vfy；法兰的坐标平面的X轴方向向量为xflange，法兰的坐标平面的Y轴方向向量为yflange；待调节的轴关节动作角度为0时，
Figure BDA00028368616100000310
推算出旋转变换Rx中的θ角度。
本发明一个优选的实施方案中，六轴机器人包括基本主轴和腕部运动次轴，所述主轴包括驱动连接底座的本体回旋轴A1，驱动连接本体回旋轴A1和大臂运动轴A2,驱动连接大臂运动轴A2和小臂运动轴A3；所述腕部运动次轴包括与小臂运动轴A3驱动连接的手腕旋转轴A4，与手腕旋转轴A4驱动连接的手腕摆动轴A5，与手腕摆动轴A5驱动连接的3D打印头的圆周转动轴A6。
本发明一个优选的实施方案中，手腕旋转轴A4或/和圆周转动轴A6的变换角度趋向于0或等于0。
本发明一个优选的实施方案中，一种三维打印设备，采用六轴机器人的轴动作优化方法。
本发明解决了技术背景中存在的缺陷，本发明有益的技术效果是：
本发明公开了一种适用于三维打印设备中的六轴机器人中的便捷、稳定的轴动作优化方法。
第一，通过根据六轴机器人中的关节轴的动作的限定反向推导出打印轨迹的角度，进一步提升了打印的稳定性、便捷性、节能性的同时，还进一步提升了动作优化方法的便捷性。
第二，通过进一步定义手腕旋转轴A4或/和圆周转动轴A6的动作变换角度的调节，实现对六轴机器人的稳定控制提供了简便的控制方法，通过控制一个关节轴的变换角度从而实现所有轴的动作优化和控制稳定性。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1是现有技术中的六轴机器人的各个轴在时间轴上的运动角度曲线图；
图2是现有技术中的对六轴机器人运动优化后的各个轴在时间轴上的运动角度曲线图；
图3是现有技术中的六轴机器人J1～J4阶段的打印轨迹的俯视结构示意图；
图4是现有技术中的六轴机器人J1～J4阶段的打印轨迹的正视结构示意图；
图5是本发明的优选实施例中六轴机器人驱动连接3D打印头的结构示意图一；
图6是本发明的优选实施例中六轴机器人驱动连接3D打印头的结构示意图二；
图7是本发明的优选实施例中六轴机器人的结构示意图；
图中附图标记的含义；A0-底座,A1-本体回旋轴，A2-大臂运动轴，A3-小臂运动轴，A4-手腕旋转轴，A5-手腕摆动轴，A6-圆周转动轴；1-六轴机器人，2-法兰，3-3D打印头，31-喷口。
具体实施方式
现在结合附图和实施例对本发明作进一步详细的说明，这些附图均为简化的示意图，仅以示意方式说明本发明的基本结构，因此其仅显示与本发明有关的构成。
需要说明，若本发明实施例中有涉及方向性指示(诸如上、下、底、顶等)，则该方向性指示仅用于解释在某一特定姿态下各部件之间的相对位置关系、运动情况等，如果该特定姿态发生改变时，则该方向性指示也相应地随之改变。术语“第一”、“第二”仅用于描述目的，而不能理解为指示或暗示相对重要性或者隐含指明所指示的技术特征的数量。由此，限定有“第一”、“第二”的特征可以明示或者隐含地包括一个或者更多个该特征。除非另有明确的规定和限定，术语“设置”、“相连”、“连接”应做广义理解，例如，可以是固定连接，也可以是可拆卸连接，或一体地连接；可以是直接相连，也可以通过中间媒介间接相连，可以是两个元件内部的连通。对于本领域的普通技术人员而言，可以具体情况理解上述术语在本发明中的具体含义。
如图5～图7所示，本实施例公开了一种三维打印设备中的六轴机器人1的轴动作优化方法，包括3D打印机，3D打印机驱动连接有六轴机器人1，六轴机器人1一端驱动设置在3D打印机上，六轴机器人1的另一端驱动连接有3D打印头3，3D打印头3对应3D打印机的打印仓；六轴机器人1包括基本主轴和腕部运动次轴，主轴包括驱动连接底座A0的本体回旋轴A1，驱动连接本体回旋轴A1的大臂运动轴A2,驱动连接大臂运动轴A2和小臂运动轴A3；腕部运动次轴包括与小臂运动轴A3驱动连接的手腕旋转轴A4，与手腕旋转轴A4驱动连接的手腕摆动轴A5，与手腕摆动轴A5驱动连接的3D打印头3的圆周转动轴A6。手腕旋转轴A4或/和圆周转动轴A6的变换角度趋向于0或等于0。本申请中是针对手腕旋转轴A4的变换角度趋向于0或等于0进行优化的方法。
具体的，3D打印中的轴动作优化方法包括以下步骤：
步骤S1，采集待打印的3D模型的结构点阵模型数据。
步骤S2，将结构点阵模型数据导入3D打印机中。
步骤S3，选择需要优化的轴关节。
步骤S4，将结构点阵模型数据中的待打印的目标点定义为目标原点坐标P。
步骤a1，将六轴机器人1根部底座A0定义为世界坐标系。
步骤a2，将结构点阵模型数据导入3D打印机，根据结构点阵模型数据和打印头的位置设定3D模型的目标原点坐标P，p＝(x,y,z)。
步骤S5，将目标原点坐标P与待优化的轴关节之间建立机械变换结构式。步骤b1，根据目标原点坐标P定义，以目标原点坐标P为原点的目标原点坐标系
Figure BDA0002836861610000061
目标原点坐标系
Figure BDA0002836861610000062
中；根据3D打印头3的喷打方向定义目标原点坐标系为
Figure BDA0002836861610000063
步骤b2，旋转变换Rx是围绕P点上的喷口31的喷涂方向旋转的旋转变换矩阵；旋转变换Rx中，
Figure BDA0002836861610000064
步骤b3，定义待调节的轴关节上与3D打印头3之间的相对法兰2的变换
Figure BDA0002836861610000065
是法兰2即tool与3D打印头3的喷口31即flange之间的相对变换位置关系；根据六轴机器人1的tx和tz，tz为待调节的轴关节上的法兰2中心与3D打印头3的中心轴线的法线，tx是tz位于D打印头中心轴线上的交点至3D打印头3端部喷口31之间的直线或线段；
Figure BDA0002836861610000071
为
Figure BDA0002836861610000072
步骤b4，根据机械臂的变换结构获得，机械变换结构式：
Figure BDA0002836861610000073
为底座0到3D打印头3的喷口31即flange之间的位置关系。法兰2的坐标平面的Z轴的方向向量为vflange，vflange在世界坐标系的X轴和Y轴上的投影为vfx和vfy；法兰2的坐标平面的X轴方向向量为xflange，法兰2的坐标平面的Y轴方向向量为yflange；待调节的轴关节动作角度为0时，
Figure BDA0002836861610000074
算出旋转变换Rx中的θ角度。
步骤S6，根据轴关节需求的动作角度，从机械变换结构式倒推打印目标原点坐标P的行动轨迹角度。
实施例一
具体的，如图5～图7所示，六轴机器人1根部底座0定义为世界坐标系，确定目标点坐标系的目标原点坐标p＝(x,y,z)。目标平面坐标系的X轴方向为3D打印头3的喷口31方向。设目标点坐标系的Z轴方向为Tx＝(r，0，z3)T，其中z3是一个未知量,r是一个非零实数，使得Z轴的向量从Top视图上看，平行于世界坐标系的X轴。但不仅限于此，在其他实施例中Z轴也可以假设成平行于世界坐标系的Y轴或任意方向。确定Tz的z3的值。由于目标点坐标系的各个方向轴之间是垂直的。
目标点坐标系的X轴垂直于目标点坐标系的Z轴，即：Tx＝(x1，y1，z1)；Tx·Tz＝0；上式展开可得：x1·r+y1·0+z1·z3＝0；可得：
Figure BDA0002836861610000075
汇总后，求得Tz：
Figure BDA0002836861610000076
所以Tz,即目标点的坐标系的Z轴方向向量的长度也能被计算出来，记为Len。
Figure BDA0002836861610000081
Figure BDA0002836861610000082
Figure BDA0002836861610000083
设：
Figure BDA0002836861610000084
所以/Len＝r*L；
单元化Tz，使之成为长度为1的向量，即把Tz的每个分量都除以L’：
Figure BDA0002836861610000085
约去r，可得单元化后的
Figure BDA0002836861610000086
由于Z轴叉乘X轴便可获得Y轴向量：
Figure BDA0002836861610000087
汇总三个基向量和坐标原点，以目标原点坐标P为原点的目标原点坐标系：
Figure BDA0002836861610000088
其中，
Figure BDA0002836861610000089
中的0，0，0，1的定义，是确保这个变换是刚体变换的2个条件之一。还有一个条件是Tx,Ty,Tz都是单位向量，且相互垂直，该变换是刚体变换。
因为在三维打印中，机器人围绕目标点平面坐标系的X轴进行旋转而不影响打印效果，转多少度，是需要要求得的结果。设围绕目标点平面的X轴旋转，为围绕P点的X轴的旋转变换矩阵：Rx；
Figure BDA00028368616100000810
3D打印头3的转角皆为正交。定义待调节的轴关节上与3D打印头3之间的相对圆周转动轴A6上的法兰2的变换
Figure BDA0002836861610000091
是法兰2即tool与3D打印头3的喷口31即flange之间的相对变换位置关系；根据六轴机器人1的tx和tz，tz为待调节的轴关节上的法兰2中心与3D打印头3中心轴线的法线，tx是tz位于3D打印头3中心轴线上的交点至3D打印头3端部喷口31之间直线。tx和tz皆为已知量，得到这个工具头相对法兰2的变换
Figure BDA0002836861610000092
根据六轴机器人1的结构，可得：
Figure BDA0002836861610000093
为底座0到3D打印头3的喷口31即flange之间的位置关系。
Figure BDA0002836861610000094
在右上角加-1是逆向，等同于是从喷口31与法兰2之间的相对变换位置关系。公式
Figure BDA0002836861610000095
的左边都为已知项，所以求得的矩阵也是已知的，计算可得：
Figure BDA0002836861610000096
其中，记录下以下向量：
Figure BDA0002836861610000097
Figure BDA0002836861610000098
Figure BDA0002836861610000099
Figure BDA00028368616100000910
当手腕旋转轴A4的变换角度是0或接近与0的时候，如图6所示的机械臂的Top视图。由图6可见，法兰2的坐标平面的Z轴的方向向量为vflange，vflange在世界坐标系的X轴和Y轴上的投影为vfx和vfy；可得：vfx＝a13，vfy＝a23。法兰2的坐标平面的X轴方向向量为xflange，法兰2的坐标平面的Y轴方向向量为yflange；与手腕旋转轴A4的旋转轴的中轴线平行。可得：xflange＝a14，yflange＝a24。因为vflange平行于手腕旋转轴A4的旋转轴的中轴线，所以可得，手腕旋转轴A4的旋转角度是0；得出，
Figure BDA0002836861610000101
即为：
Figure BDA0002836861610000102
把得到的a13，a23，a14，a24代入方程，这是个未知量为θ的一元方程，计算求得θ：
Figure BDA0002836861610000103
把θ代入实际场景,算出结果，得出优化算法。在确定θ后，通过：
Figure BDA0002836861610000104
其中b13，b23，b33即为目标平面坐标系的z轴的方向向量的x、y、z的三个分量，计算可得：
Figure BDA0002836861610000105
Figure BDA0002836861610000106
Figure BDA0002836861610000107
得出优化动作轨迹。
本发明工作原理：如图5～图7所示，采集待打印的3D模型的结构点阵模型数据；将结构点阵模型数据导入3D打印机中，选择需要优化的轴关节；将结构点阵模型数据中的待打印的目标点定义为目标原点坐标P；将目标原点坐标P与待优化的轴关节之间建立机械变换结构式；根据轴关节需求的动作角度，从机械变换结构式倒推打印目标原点坐标P的行动轨迹角度。
以上具体实施方式是对本发明提出的方案思想的具体支持，不能以此限定本发明的保护范围，凡是按照本发明提出的技术思想，在本技术方案基础上所做的任何等同变化或等效的改动，均仍属于本发明技术方案保护的范围。

Claims (10)

1.一种三维打印设备中的六轴机器人的轴动作优化方法，包括3D打印机，3D打印机驱动连接有六轴机器人，所述六轴机器人一端驱动设置在3D打印机上，所述六轴机器人的另一端驱动连接有3D打印头，所述3D打印头对应所述3D打印机的打印仓；其特征在于：所述3D打印中的轴动作优化方法包括以下步骤；
步骤S1，采集待打印的3D模型的结构点阵模型数据；
步骤S2，将结构点阵模型数据导入3D打印机中，
步骤S3，选择需要优化的轴关节；
步骤S4，将结构点阵模型数据中的待打印的目标点定义为目标原点坐标P；
步骤S5，将目标原点坐标P与待优化的轴关节之间建立机械变换结构式；
步骤S6，根据轴关节需求的动作角度，从机械变换结构式倒推打印目标原点坐标P的行动轨迹角度。
2.根据权利要求1所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述步骤S4中，还包括，
步骤a1，将六轴机器人根部的底座定义为世界坐标系；
步骤a2，将结构点阵模型数据导入3D打印机，根据结构点阵模型数据和打印头的位置设定3D模型的目标原点坐标P，p＝(x,y,z)。
3.根据权利要求2所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述步骤S5中，还包括，
步骤b1，根据目标原点坐标P定义以目标原点坐标P为原点的目标原点坐标系
Figure FDA0002836861600000011
步骤b2，旋转变换Rx是围绕P点上的3D打印头的喷口的喷涂方向旋转的旋转变换矩阵；
步骤b3，定义待调节的轴关节上与3D打印头之间的相对轴关节上法兰的变换
Figure FDA0002836861600000012
是轴关节的法兰tool与3D打印头的喷口flange之间的相对变换位置关系；
步骤b4，根据机械臂的变换结构获得，机械变换结构式
Figure FDA0002836861600000021
Figure FDA0002836861600000022
为底座0到3D打印头的喷口flange之间的位置关系。
4.根据权利要求3所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述步骤b1中，还包括，
所述目标原点坐标系
Figure FDA0002836861600000023
中；根据3D打印头的喷打方向定义目标原点坐标系为
Figure FDA0002836861600000024
Figure FDA0002836861600000025
5.根据权利要求4所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述步骤b2中，还包括，
所述旋转变换Rx中，
Figure FDA0002836861600000026
6.根据权利要求5所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述步骤b3中，还包括，根据六轴机器人的tx和tz，tz为待调节的轴关节上的法兰中心与3D打印头中心轴线的法线，tx是tz位于D打印头中心轴线上的交点至3D打印头的端部的喷口之间直线；所述
Figure FDA0002836861600000028
为
Figure FDA0002836861600000027
7.根据权利要求6所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：法兰的坐标平面的Z轴的方向向量为vflange，vflange在世界坐标系的X轴和Y轴上的投影为vfx和vfy；法兰的坐标平面的X轴方向向量为xflange，法兰的坐标平面的Y轴方向向量为yflange；待调节的轴关节动作角度为0时，
Figure FDA0002836861600000029
推算出旋转变换Rx中的θ角度。
8.根据权利要求7所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述六轴机器人包括基本主轴和腕部运动次轴，所述主轴包括驱动连接底座的本体回旋轴A1，驱动连接本体回旋轴A1和大臂运动轴A2,驱动连接大臂运动轴A2和小臂运动轴A3；所述腕部运动次轴包括与小臂运动轴A3驱动连接的手腕旋转轴A4，与手腕旋转轴A4驱动连接的手腕摆动轴A5，与手腕摆动轴A5驱动连接的3D打印头的圆周转动轴A6。
9.根据权利要求8所述的一种三维打印设备中的六轴机器人的轴动作优化方法，其特征在于：所述手腕旋转轴A4或/和圆周转动轴A6的变换角度趋向于0或等于0。
10.一种三维打印设备，其特征在于：采用权利要求1～权利要求9中任一权利要求中所述的六轴机器人的轴动作优化方法。
CN202011473683.4A 2020-12-15 2020-12-15 一种三维打印设备中的六轴机器人的轴动作优化方法 Active CN112776341B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202011473683.4A CN112776341B (zh) 2020-12-15 2020-12-15 一种三维打印设备中的六轴机器人的轴动作优化方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202011473683.4A CN112776341B (zh) 2020-12-15 2020-12-15 一种三维打印设备中的六轴机器人的轴动作优化方法

Publications (2)

Publication Number Publication Date
CN112776341A true CN112776341A (zh) 2021-05-11
CN112776341B CN112776341B (zh) 2022-07-08

Family

ID=75750890

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202011473683.4A Active CN112776341B (zh) 2020-12-15 2020-12-15 一种三维打印设备中的六轴机器人的轴动作优化方法

Country Status (1)

Country Link
CN (1) CN112776341B (zh)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2584104A1 (en) * 2004-10-19 2006-04-27 Rolls-Royce Corporation Method and apparatus associated with anisotropic shrink in sintered ceramic items
US20150024233A1 (en) * 2013-07-19 2015-01-22 The Boeing Company Quality control of additive manufactured parts
CN105773961A (zh) * 2014-12-18 2016-07-20 泰科电子(上海)有限公司 3d打印方法
CN107791248A (zh) * 2017-09-28 2018-03-13 浙江理工大学 基于不满足pipper准则的六自由度串联机器人的控制方法
CN108247058A (zh) * 2018-03-12 2018-07-06 广东水利电力职业技术学院（广东省水利电力技工学校） 一种3d打印智能送粉系统
CN111347678A (zh) * 2020-03-09 2020-06-30 西南交通大学 一种多关节工业机器人3d打印后处理与路径优化方法

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CA2584104A1 (en) * 2004-10-19 2006-04-27 Rolls-Royce Corporation Method and apparatus associated with anisotropic shrink in sintered ceramic items
US20150024233A1 (en) * 2013-07-19 2015-01-22 The Boeing Company Quality control of additive manufactured parts
CN105773961A (zh) * 2014-12-18 2016-07-20 泰科电子(上海)有限公司 3d打印方法
CN107791248A (zh) * 2017-09-28 2018-03-13 浙江理工大学 基于不满足pipper准则的六自由度串联机器人的控制方法
CN108247058A (zh) * 2018-03-12 2018-07-06 广东水利电力职业技术学院（广东省水利电力技工学校） 一种3d打印智能送粉系统
CN111347678A (zh) * 2020-03-09 2020-06-30 西南交通大学 一种多关节工业机器人3d打印后处理与路径优化方法

Also Published As

Publication number Publication date
CN112776341B (zh) 2022-07-08

Similar Documents

Publication Publication Date Title
JP3207728B2 (ja) 冗長マニピュレータの制御方法
CN113601512B (zh) 一种机械臂奇异点的通用规避方法与系统
CN107901041A (zh) 一种基于图像混合矩的机器人视觉伺服控制方法
US20030171847A1 (en) Method of controlling a robot through a singularity
CN108068113B (zh) 7-dof仿人臂飞行物体作业最小加速度轨迹优化
WO2021076453A1 (en) Dynamic planning controller
CN111390872A (zh) 一种舱外机器人双臂协同柔性拖拽与对接逆操作方法
CN111347431A (zh) 一种手持工具示教的机器人示教喷涂方法和装置
CN111687827B (zh) 一种双机器人协调操作弱刚性构件的控制方法和控制系统
Li et al. A hybrid visual servo control method for simultaneously controlling a nonholonomic mobile and a manipulator
CN111515928B (zh) 机械臂运动控制系统
CN109571481A (zh) 一种关节奇异点处理方法、装置、设备和存储介质
WO2020173111A1 (zh) 一种 3d 微涂覆机器人及其涂覆方法
CN114378827B (zh) 一种基于移动机械臂整体控制的动态目标跟踪抓取方法
CN114942593B (zh) 一种基于干扰观测器补偿的机械臂自适应滑模控制方法
CN110545965B (zh) 多关节机器人以及多关节机器人系统
CN115674208B (zh) 一种机器人振动抑制装置、控制方法及其机器人
CN114310914A (zh) 多自由度机械臂模糊自适应迭代轨迹跟踪控制方法及系统
CN114012507A (zh) 一种摇篮式五轴机床双旋转轴位置无关误差的辨识方法
CN112318508A (zh) 一种水下机器人-机械手系统受海流扰动强弱评估方法
CN112776341B (zh) 一种三维打印设备中的六轴机器人的轴动作优化方法
CN117340391A (zh) 一种基于激光视觉的实时自适应的焊缝跟踪装置及方法
CN115366115B (zh) 一种机械臂控制方法及其控制系统和计算机可读存储介质
CN116237938A (zh) 一种基于冗余自由度利用的旋翼飞行机械臂协调运动规划方法
US20230302645A1 (en) Method of robot dynamic motion planning and control

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
CB02 Change of applicant information
CB02 Change of applicant information

Address after: 200092 Siping Road 1239, Shanghai, Yangpu District

Applicant after: TONGJI University

Applicant after: Shanghai yizao Technology Co.,Ltd.

Address before: 200092 Siping Road 1239, Shanghai, Yangpu District

Applicant before: TONGJI University

Applicant before: SHANGHAI YIZAO BUILDING INTELLIGENT ENGINEERING Co.,Ltd.

GR01 Patent grant
GR01 Patent grant