CN112975916B - Two-turn and one-shift parallel mechanism, its end pose determination method and application - Google Patents
Two-turn and one-shift parallel mechanism, its end pose determination method and application Download PDFInfo
- Publication number
- CN112975916B CN112975916B CN202110402920.6A CN202110402920A CN112975916B CN 112975916 B CN112975916 B CN 112975916B CN 202110402920 A CN202110402920 A CN 202110402920A CN 112975916 B CN112975916 B CN 112975916B
- Authority
- CN
- China
- Prior art keywords
- platform
- moving
- static platform
- pair
- redundant
- 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
- 230000007246 mechanism Effects 0.000 title claims abstract description 49
- 238000000034 method Methods 0.000 title claims abstract description 11
- 230000003068 static effect Effects 0.000 claims abstract description 114
- 230000002093 peripheral effect Effects 0.000 claims description 9
- 230000000712 assembly Effects 0.000 claims description 8
- 238000000429 assembly Methods 0.000 claims description 8
- 238000012546 transfer Methods 0.000 claims description 5
- 230000033001 locomotion Effects 0.000 description 7
- 230000009466 transformation Effects 0.000 description 5
- 238000013461 design Methods 0.000 description 4
- 238000010586 diagram Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000008602 contraction Effects 0.000 description 2
- 238000006073 displacement reaction Methods 0.000 description 2
- 238000009434 installation Methods 0.000 description 2
- 239000011159 matrix material Substances 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000007792 addition Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003814 drug Substances 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0033—Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
- B25J9/0036—Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base with kinematics chains of the type prismatic-rotary-rotary
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1602—Programme controls characterised by the control system, structure, architecture
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/16—Programme controls
- B25J9/1615—Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
- B25J9/1623—Parallel manipulator, Stewart platform, links are attached to a common base and to a common platform, plate which is moved parallel to the base
Landscapes
- Engineering & Computer Science (AREA)
- Robotics (AREA)
- Mechanical Engineering (AREA)
- Health & Medical Sciences (AREA)
- General Health & Medical Sciences (AREA)
- Orthopedic Medicine & Surgery (AREA)
- Automation & Control Theory (AREA)
- Transmission Devices (AREA)
Abstract
本发明公开了一种两转一移并联机构、其末端位姿确定方法及应用。所述两转一移并联机构包括动平台、基座和三个支链,基座包括静平台、冗余静平台及连接静平台和冗余静平台的多个连接件,冗余静平台位于动平台和静平台之间,且冗余静平台上设有三个通孔,三个支链连接于动平台和静平台之间,每个支链包括驱动移动副、第一被动移动副、第二被动移动副和球面副,每个驱动移动副的一端通过第一被动移动副与静平台可移动地连接,相对端穿过冗余静平台的一通孔后通过对应的球面副与动平台可转动地连接,且驱动移动副还通过第二被动移动副与冗余静平台可移动地连接。本发明能够降低动平台与静平台之间的间距,提高系统刚度。
The invention discloses a two-transition and one-shift parallel mechanism, a method for determining the position and attitude of its end and its application. The two-turn-one-shift parallel mechanism includes a moving platform, a base, and three branch chains. The base includes a static platform, a redundant static platform, and a plurality of connectors connecting the static platform and the redundant static platform. The redundant static platform is located at the Between the moving platform and the static platform, and the redundant static platform is provided with three through holes, three branch chains are connected between the moving platform and the static platform, and each branch chain includes a driving moving pair, a first passive moving pair, a second Two passive moving pairs and spherical pairs, one end of each driving moving pair is movably connected to the static platform through the first passive moving pair, and the opposite end passes through a through hole of the redundant static platform and can be connected to the moving platform through the corresponding spherical pair. are rotatably connected, and the driving moving pair is also movably connected to the redundant static platform through a second passive moving pair. The invention can reduce the distance between the moving platform and the static platform and improve the rigidity of the system.
Description
技术领域technical field
本发明属于机器人技术领域,具体涉及一种两转一移三自由度并联机构及其末端位姿的确定方法。The invention belongs to the technical field of robots, and in particular relates to a two-rotation and one-shift three-degree-of-freedom parallel mechanism and a method for determining the position and posture of its end.
背景技术Background technique
并联机器人和串联机器人一起构成工业机器人的重要部分,并联机器人具有刚度高、速度快、柔性强、重量轻等优点,在食品、医药、电子等轻工业中应用最为广泛,在物料的搬运、包装、分拣等方面有着无可比拟的优势。随着并联机器人在市场中的应用日益广泛,已成为工业机器人需求增长的新生力量。Parallel robots and serial robots together constitute an important part of industrial robots. Parallel robots have the advantages of high stiffness, high speed, strong flexibility, and light weight. They are most widely used in light industries such as food, medicine, and electronics. Sorting and other aspects have unparalleled advantages. With the increasing application of parallel robots in the market, it has become a new force for the growth of industrial robot demand.
并联机器人与串联机器人不同,并联机器人是由动平台、静平台以及连接动平台和静平台的两个或两个以上独立运动支链组成的闭环系统,与传统串联机器人相比,并联机器人没有误差累积,运动精度高,驱动可以布置在静平台附近,运动惯量小,动态性好等优点。The parallel robot is different from the series robot. The parallel robot is a closed-loop system composed of a moving platform, a static platform, and two or more independent moving branches connecting the moving platform and the static platform. Compared with the traditional series robot, the parallel robot has no errors. Accumulation, high motion accuracy, the drive can be arranged near the static platform, the motion inertia is small, and the dynamic performance is good.
目前,自由度少于6的并联机器人是国内外研究及应用的热点,具有两个转动和一个移动自由度的三自由度并联机器人又是少自由度并联机器人中的重要分类。3PPS并联机器人是两转一移并联机器人中的典型,可应用在运动模拟器、末端执行器、矢量推进器、医疗器械等领域。但是,在实际制造3PPS并联机器人的过程中,由于驱动移动副所采用的电动推杆、液压缸等直线驱动的本体较长,造成动平台与静平台间距大,动平台在负载的作用下,相对于静平台容易产生变形,系统整体刚度较差。At present, parallel robots with less than 6 degrees of freedom are the research and application hotspots at home and abroad. Three-degree-of-freedom parallel robots with two rotational degrees of freedom and one moving degree of freedom are also an important category of parallel robots with few degrees of freedom. The 3P P S parallel robot is a typical two-turn and one-shift parallel robot, which can be used in motion simulators, end effectors, vector thrusters, medical equipment and other fields. However, in the process of actually manufacturing the 3P P S parallel robot, due to the long body of the linear drive such as the electric push rod and hydraulic cylinder used to drive the moving pair, the distance between the moving platform and the static platform is large, and the moving platform plays a role in the load. Compared with the static platform, it is easy to deform, and the overall stiffness of the system is poor.
发明内容SUMMARY OF THE INVENTION
本发明的主要目的在于提供一种两转一移并联机构,降低动平台与静平台之间的间距的同时提高系统刚度,同时,还提供一种两转一移并联机构的末端位姿确定方法。The main purpose of the present invention is to provide a two-rotation-one-shift parallel mechanism, which reduces the distance between the moving platform and the static platform while improving the rigidity of the system, and also provides a method for determining the end pose of the two-rotation-one-shift parallel mechanism .
为实现前述发明目的,本发明采用的技术方案包括:一种两转一移并联机构,所述两转一移并联机构包括:In order to achieve the aforementioned purpose of the invention, the technical solution adopted in the present invention includes: a two-turn-one-shift parallel mechanism, wherein the two-turn-one-shift parallel mechanism includes:
动平台;mobile platform;
基座,所述基座包括静平台、冗余静平台及连接所述静平台和冗余静平台的多个连接件,所述冗余静平台位于所述动平台和静平台之间,且所述冗余静平台上设有三个通孔;a base, the base includes a static platform, a redundant static platform, and a plurality of connectors connecting the static platform and the redundant static platform, the redundant static platform is located between the dynamic platform and the static platform, and The redundant static platform is provided with three through holes;
三个支链,连接于所述动平台和静平台之间,每个所述支链包括驱动移动副、第一被动移动副、第二被动移动副和球面副,每个驱动移动副的一端通过第一被动移动副与静平台可移动地连接,相对端穿过冗余静平台的一通孔后通过对应的球面副与动平台可转动地连接,且所述驱动移动副还通过第二被动移动副与冗余静平台可移动地连接。Three branched chains are connected between the moving platform and the static platform, each of the branched chains includes a driving moving pair, a first passive moving pair, a second passive moving pair and a spherical pair, and one end of each driving moving pair The first passive moving pair is movably connected to the static platform, the opposite end is rotatably connected to the moving platform through a corresponding spherical pair after passing through a through hole of the redundant static platform, and the driving moving pair is also connected to the moving platform through the second passive moving pair. The mobile pair is movably connected to the redundant static platform.
优选地,所述第一被动移动副包括至少一个用于使驱动移动副导向移动的第一滑轨组件,所述第一滑轨组件包括第一滑块及供第一滑块导向移动的第一导轨,所述第一滑块滑动设于所述第一导轨上,所述第一滑块和第一导轨中的任意一个固定于静平台上,另一个与驱动移动副相连。Preferably, the first passive moving pair includes at least one first sliding rail assembly for guiding and moving the driving moving pair, and the first sliding rail assembly includes a first sliding block and a first sliding block for guiding and moving the first sliding block. A guide rail, the first sliding block is slidably arranged on the first guide rail, any one of the first sliding block and the first guide rail is fixed on the static platform, and the other is connected with the driving moving pair.
优选地,所述第二被动移动副包括至少一个用于使驱动移动副导向移动的第二滑轨组件,所述第二滑轨组件包括第二滑块及供第二滑块导向移动的第二导轨,所述第二滑块滑动设于所述第二导轨上,所述第二滑块和第二导轨中的任意一个固定于冗余静平台上,另一个与驱动移动副相连。Preferably, the second passive moving pair includes at least one second sliding rail assembly for guiding and moving the driving moving pair, and the second sliding rail assembly includes a second sliding block and a first sliding block for guiding and moving the second sliding block. Two guide rails, the second sliding block is slidably arranged on the second guide rail, any one of the second sliding block and the second guide rail is fixed on the redundant static platform, and the other is connected to the driving moving pair.
优选地,所述第二滑轨组件设于所述冗余静平台上,且位于所述冗余静平台和动平台之间;或者,所述第二滑轨组件设于所述冗余静平台上,且位于所述冗余静平台和静平台之间。Preferably, the second slide rail assembly is provided on the redundant static platform and is located between the redundant static platform and the moving platform; or, the second slide rail assembly is provided on the redundant static platform on the platform and between the redundant static platform and the static platform.
优选地,所述第二被动移动副包括两个第二滑轨组件,所述通孔的两侧设置一所述第二滑轨组件,且两个所述第二滑轨组件对称设置。Preferably, the second passive moving pair includes two second slide rail assemblies, one of the second slide rail assemblies is provided on both sides of the through hole, and the two second slide rail assemblies are symmetrically arranged.
优选地,三个所述支链的一端在动平台的表面排布成正三角形,相对端在静平台上排布成正三角形。Preferably, one end of the three branch chains is arranged in an equilateral triangle on the surface of the moving platform, and the opposite ends are arranged in an equilateral triangle on the static platform.
优选地,所述动平台包括平台本体部和三个凸耳部,所述平台本体部的周侧面向外凸起延伸形成三个所述凸耳部,相邻两个所述凸耳部的中心线夹角为120度。Preferably, the moving platform includes a platform body portion and three lug portions, and the peripheral surface of the platform body portion protrudes outward to form three lug portions, and the adjacent two lug portions have three lug portions. The angle between the center lines is 120 degrees.
优选地,所述静平台包括第一本体部和三个第一延伸部,第一本体部的周侧面向外凸起延伸形成三个第一延伸部,相邻两个第一延伸部的中心线夹角为120度。Preferably, the static platform includes a first body part and three first extension parts, and the peripheral surface of the first body part protrudes outward to form three first extension parts, and the centers of the adjacent two first extension parts The angle between the lines is 120 degrees.
优选地,所述冗余静平台包括第二本体部和三个第二延伸部,第二本体部的周侧面向外凸起延伸形成三个第二延伸部,相邻两个第二延伸部的中心线夹角为120度。Preferably, the redundant static platform includes a second body part and three second extension parts, and the peripheral surface of the second body part protrudes outwardly to form three second extension parts, two adjacent second extension parts The centerline angle is 120 degrees.
本发明还揭示了一种两转一移并联机构的末端位姿确定方法,包括如下步骤:The present invention also discloses a method for determining the end pose of a two-turn-one-shift parallel mechanism, comprising the following steps:
获取每个支链的伸长量,并根据如下公式计算两转一移并联机构的末端位姿:Obtain the elongation of each branch chain, and calculate the end pose of the two-turn-one-shift parallel mechanism according to the following formula:
其中,、、分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度,为三个球面副的几何中心、、构成的正三角的外接圆的半径,为正三角形的外接圆的圆心的坐标值。in, , , are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively, is the geometric center of the three spherical pairs , , The radius of the circumcircle of the formed regular triangle, It is the coordinate value of the center of the circumcircle of the equilateral triangle.
本发明还揭示了一种少自由度并联机器人,其包括所述的两转一移并联机构。The invention also discloses a parallel robot with few degrees of freedom, which includes the two-transition and one-shift parallel mechanism.
与现有技术相比较,本发明的有益效果至少在于:Compared with the prior art, the beneficial effects of the present invention are at least as follows:
(1)本发明通过在静平台的基础上增加了与静平台相配合的冗余静平台,形成双层结构,以对支链中的驱动移动副进行双层冗余约束,能够有效降低动平台和静平之间的距离,显著提升系统刚度。(1) The present invention forms a double-layer structure by adding a redundant static platform matched with the static platform on the basis of the static platform, so as to carry out double-layer redundant constraints on the driving moving pair in the branch chain, which can effectively reduce the dynamic pressure. The distance between the platform and the static level significantly increases the stiffness of the system.
(2)本发明采用双层结构设计的基座,适用范围广,也即本发明所采用的设计方式扩大了3PPS并联机构的基座范围,使得并联机构与其它设备的接口安装更加灵活,不仅可以垂直安装,还可以利用任意一个侧面水平安装。(2) The present invention adopts a base designed with a double-layer structure, which has a wide range of applications, that is, the design method adopted in the present invention expands the base range of the 3P P S parallel mechanism, making the interface installation of the parallel mechanism and other equipment more flexible , not only can be installed vertically, but also can be installed horizontally using any side.
(3)本发明还具有结构对称且紧凑、可靠性高、动态性能好、控制简单且精度高的优点。(3) The present invention also has the advantages of symmetrical and compact structure, high reliability, good dynamic performance, simple control and high precision.
附图说明Description of drawings
为了更清楚地说明本发明实施例或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍,显而易见地,下面描述中的附图仅仅是本发明中记载的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to explain the embodiments of the present invention or the technical solutions in the prior art more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the embodiments or the prior art. Obviously, the accompanying drawings in the following description are only These are some embodiments described in the present invention. For those of ordinary skill in the art, other drawings can also be obtained based on these drawings without any creative effort.
图1是本发明实施例一中两转一移并联机构的立体示意图;Fig. 1 is the three-dimensional schematic diagram of the two-turn-one-shift parallel mechanism in the first embodiment of the present invention;
图2是本发明实施例二中两转一移并联机构的立体示意图;Fig. 2 is the three-dimensional schematic diagram of the parallel mechanism of two shifts and one shift in the second embodiment of the present invention;
图3是本发明一典型实施例中两转一移并联机构的原理图。FIG. 3 is a schematic diagram of a two-rotation and one-shift parallel mechanism in a typical embodiment of the present invention.
附图标记:10、动平台,10a、平台本体部,10b、凸耳部,20、基座,21、静平台,21a、第一本体部,21b、第一延伸部,22、冗余静平台,22a、第二本体部,22b、第二延伸部,221、通孔,23、连接件,30、支链,31、驱动移动副,31a、直线驱动伸缩杆,31b、直线驱动本体,31c、直线驱动底座,32、第一被动移动副,32a、第一滑块,32b、第一导轨,33、第二被动移动副,33a、第二滑块,33b、第二导轨,34、球面副,40、法兰。Reference numerals: 10, moving platform, 10a, platform body part, 10b, lug part, 20, base, 21, static platform, 21a, first body part, 21b, first extension part, 22, redundant static Platform, 22a, second body part, 22b, second extension part, 221, through hole, 23, connecting piece, 30, branch chain, 31, drive moving pair, 31a, linear drive telescopic rod, 31b, linear drive body, 31c, linear drive base, 32, first passive moving pair, 32a, first sliding block, 32b, first guide rail, 33, second passive moving pair, 33a, second sliding block, 33b, second guide rail, 34, Spherical pair, 40, flange.
具体实施方式Detailed ways
通过应连同所附图式一起阅读的以下具体实施方式将更完整地理解本发明。本文中揭示本发明的详细实施例;然而,应理解,所揭示的实施例仅具本发明的示范性,本发明可以各种形式来体现。因此,本文中所揭示的特定功能细节不应解释为具有限制性,而是仅解释为权利要求书的基础且解释为用于教示所属领域的技术人员在事实上任何适当详细实施例中以不同方式采用本发明的代表性基础。The present invention will be more fully understood from the following detailed description, which should be read in conjunction with the accompanying drawings. Detailed embodiments of the present invention are disclosed herein; however, it is to be understood that the disclosed embodiments are merely exemplary of the invention, which may be embodied in various forms. Therefore, specific functional details disclosed herein are not to be interpreted as limiting, but merely as a basis for the claims and for teaching one skilled in the art to vary in virtually any suitable detailed embodiment. The manner adopts the representative basis of the present invention.
本发明以下实施例所揭示的一种两转一移并联机构,通过对支链中的驱动移动副进行双层冗余约束,即在静平台的基础上增加了与静平台相配合的冗余静平台,形成双层结构,能够有效降低动平台和静平台之间的距离,显著提升系统刚度。A two-rotation and one-shift parallel mechanism disclosed in the following embodiments of the present invention implements double-layer redundancy constraints on the driving moving pair in the branch chain, that is, on the basis of the static platform, the redundancy matching with the static platform is added. The static platform forms a double-layer structure, which can effectively reduce the distance between the moving platform and the static platform and significantly improve the system rigidity.
以下以两个实施例对本发明所述的两转一移并联机构进行详细地说明:The two-transfer-one-shift parallel mechanism of the present invention is described in detail below with two embodiments:
实施例一:如图1所示,为本实施例所揭示的一种两转一移并联机构,该两转一移并联机构为3PPS并联机构(P为移动副,P为驱动移动副,S为球面副),包括动平台10、基座20和三个支链30,三个支链30安装于基座20上并与动平台10相连,通过协同控制三个支链30的伸缩量,可使动平台10实现两转一移的位姿变换。具体地,基座20包括静平台21、冗余静平台22和多个连接件23,静平台21和冗余静平台22相对设置,冗余静平台22位于动平台10和静平台21之间,且冗余静平台22上设有三个通孔221,每个连接件23的一端与静平台21相连,相对端与冗余静平台22相连,最终形成双层结构;每个支链30连接于动平台10和静平台21之间,每个支链30包括驱动移动副31、第一被动移动副32、第二被动移动副33和球面副34,驱动移动副31的一端通过第一被动移动副32与静平台21可移动地连接,相对端穿过冗余静平台22上的通孔221后通过球面副34与动平台10可转动地连接,驱动移动副31还通过第二被动移动副33与静平台21可移动地连接。通过采用双层结构设计的基座20,也即采用由静平台21和冗余静平台22构成的双层结构,可对支链30中驱动移动副31进行双层冗余约束,可降低动平台10与静平台21间的间距,显著改善系统刚度,这里的间距指的是动平台10与冗余静平台22之间的距离。该双层冗余约束设计的基座20不仅仅适用于3PPS并联机构,对于其他采用电动推杆、液压缸等直线驱动作为驱动移动副31的机构也适用,适用范围广。Embodiment 1: As shown in FIG. 1 , a two-turn-one-shift parallel mechanism disclosed in this embodiment is a 3P P S parallel mechanism (P is a moving pair, and P is a driving moving pair. , S is a spherical pair), including a moving
本实施例中,通孔221优选矩形孔,当然,其他实施例中,也可根据实际需求设置通孔221的形状,如圆形等等。三个支链30围绕静平台的中心呈正三角形排布,也即支链30的一端在动平台10的表面排布成正三角形,相对端在静平台21上排布成正三角形,每个支链30的端部到各自中心的距离相同,且相邻两个支链30之间的夹角为120度,每个支链30中驱动移动副31为直线移动机构,包括直线驱动伸缩杆31a、直线驱动本体31b和直线驱动底座31c,直线驱动本体31b连接于直线驱动伸缩杆31a和直线驱动底座31c之间,直线驱动本体31b驱动直线伸缩杆实现伸缩。实施时,直线移动机构可选择电动推杆、液压缸等等。三个球面副34在动平台10上排布成正三角形,球面副34优选球轴承,球轴承具有轴承底座和与轴承底座相连并可相对轴承底座转动的连接柄,当然,在其他实施例中,可选择具有同种功能的机构,如关节球铰。In this embodiment, the through
如图1所示,每个第一被动移动副32包括设于静平台21上的至少一个第一滑轨组件,第一滑轨组件用于使驱动移动副31导向移动。具体地,第一滑轨组件包括第一滑块32a和第一导轨32b,第一滑块32a滑动设于第一导轨32b上,第一滑块32a与直线移动机构的直线驱动底座31c通过螺丝相连,第一导轨32b沿静平台21的径向方向延伸设置,用于供第一滑块32a导向移动。As shown in FIG. 1 , each first
本实施例中,三个第一导轨32b中,相邻两个第一导轨32b之间的夹角为120度,当然,在其他实施例中,可根据实际需求进行设置,也可将第一滑块32a设于静平台21上。In this embodiment, among the three
每个第二被动移动副33包括设于冗余静平台22上的至少一个第二滑轨组件,第二滑轨组件用于使驱动移动副31导向移动。具体地,第二滑轨组件包括第二滑块33a和第二导轨33b,第二滑块33a滑动设于第二导轨33b上,第二滑块33a通过法兰40与直线移动机构的直线驱动本体31b相连,第二导轨33b沿冗余静平台22的径向方向延伸设置,用于供第二滑块33a导向移动。Each second
本实施例中,三个第二导轨33b中,相邻两个第二导轨33b之间的夹角为120度,当然,在其他实施例中,可根据实际需求进行设置,也可将第二滑块33a设于冗余静平台22上。另外,本实施例中,每个第二被动移动副33包括两个第二滑轨组件,每个通孔221的两侧设置对应的两个第二滑轨组件,并且两个第二滑轨组件对称设置。In this embodiment, among the three
如图1所示,第二被动移动副33中的第二滑轨组件在冗余静平台22上的位置可根据实际需求进行设置。具体地,冗余静平台22具有相对设置的第一端面和第二端面,第一端面朝向动平台10,第二端面朝向静平台21,本实施例中,每个第二被动移动副33中的第二滑轨组件设于冗余静平台22的第一端面上。如图所示,每个第二被动移动副33中的第二滑轨组件设于冗余静平台22的第一端面上,也即每个第二被动移动副33中的第二滑轨组件位于冗余静平台22和动平台10之间。通过合理设置第二被动移动副33的位置,也能够相应降低动平台10和静平台21之间的间距。As shown in FIG. 1 , the position of the second sliding rail assembly in the second
如图1所示,动平台10包括平台本体部10a和三个凸耳部10b,平台本体部10a整体圆柱形,其周侧面向外凸起延伸形成三个凸耳部10b,相邻两个凸耳部10b的中心线夹角为120度,也即三个凸耳部10b围绕本体部呈120度分布。每个凸耳部10b上安装一球面副34,每个驱动移动副31通过球面副34与一凸耳部10b固定连接。本实施例中,每个凸耳部10b上安装一球轴承,每个直线移动机构通过球轴承与一凸耳部10b固定连接,实施时,球轴承的轴承底座可通过螺丝与动平台10的凸耳部10b相固定连接,连接柄通过螺纹连接方式与直线移动机构中的直线驱动伸缩杆31a的端部相连。As shown in FIG. 1 , the moving
如图1所示,静平台21整体呈Y形,其包括第一本体部21a和三个第一延伸部21b,第一本体部21a的周侧面向外凸起延伸形成三个第一延伸部21b,相邻两个第一延伸部21b的中心线夹角为120度,也即三个第一延伸部21b围绕本体部呈120度分布。每个第一延伸部21b上安装第一被动移动副32,每个驱动移动副31通过第一被动移动副32与对应的第一延伸部21b可移动地连接。本实施例中,每个第一延伸部21b上安装第一滑轨组件,每个直线移动机构中的直线驱动底座31c通过第一滑轨组件与对应的第一延伸部21b可移动地连接,在第一滑轨组件的作用下,直线驱动底座31c可相对对应的第一延伸部21b移动,实施时,直线驱动底座31c通过螺丝与第一滑轨组件中的第一滑块32a相连,第一导轨通过螺丝与对应第一延伸部21b固定连接。As shown in FIG. 1 , the
如图1所示,冗余静平台22整体呈Y形,其包括第二本体部22a和三个第二延伸部22b,第二本体部22a的周侧面向外凸起延伸形成三个第二延伸部22b,相邻两个第二延伸部22b的中心线夹角为120度,也即三个第二延伸部22b围绕本体部呈120度分布。每个第二延伸部22b上安装第二被动移动副33,每个驱动移动副31通过第二被动移动副33与对应的第二延伸部22b可移动地连接。本实施例中,每个第二延伸部22b设置所述供直线驱动本体31b穿过的通孔221,通孔221的两侧设置均设置一个第二滑轨组件,每个直线移动机构中的直线驱动本体31b通过第二滑轨组件与对应的第二延伸部22b可移动地连接,在第二滑轨组件的作用下,直线驱动本体31b可相对对应的第二延伸部22b移动,实施时,直线驱动本体31b通过法兰40与第二滑轨组件中的第二滑块33a相连,第二导轨通过螺丝与对应第二延伸部22b固定连接。As shown in FIG. 1 , the redundant
本发明中动平台10、静平台21及冗余静平台22均为减重优化设计结构,当然,在其他实施例中,也可采用其他形状结构,如圆形结构、三角形结构、正方形结构等等。In the present invention, the moving
实施例二:如图2所示,为本实施例所揭示的一种两转一移并联机构,包括动平台10、基座20和三个支链30,三个支链30安装于基座20上并与动平台10相连,通过协同控制三个支链30的伸缩量,可使动平台10实现两转一移的位姿变换。与实施例一不同的是,本实施例中,在每个支链30中,每个第二被动移动副33中的第二滑轨组件设于冗余静平台22的第二端面上,也即每个第二被动移动副33中的第二滑轨组件位于静平台21和动平台10之间。Embodiment 2: As shown in FIG. 2 , a two-transfer and one-shift parallel mechanism disclosed in this embodiment includes a moving
结合图1~图3所示,本发明还揭示了上述两个实施例所提供的两转一移并联机构的末端位姿确定方法,包括如下步骤:With reference to FIGS. 1 to 3 , the present invention also discloses the method for determining the end pose of the two-turn-one-shift parallel mechanism provided by the above two embodiments, including the following steps:
获取每个支链30的伸长量,并根据如下公式计算两转一移并联机构的末端位姿:Obtain the elongation of each
其中,、、分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度,为三个球面副34的几何中心、、构成的正三角形的外接圆的半径,为正三角形的外接圆的圆心的坐标值。in, , , are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively, is the geometric center of the three
具体地,如图3所示,上述公式可以通过如下步骤获得:三个球面副34的几何中心、、构成一个正三角形,该正三角形的外接圆半径为,以正三角形的外接圆圆心P为原点建立局部坐标系,其中与共线且轴的正方向与同向,与平行且的正方向与同向,的方向根据右手定则确定。以静平台21的几何中心为原点建立全局坐标系,全局坐标系坐标轴的方向与局部坐标系一致。该图3中,q1、q2、q3是三个驱动移动副的伸长量,B1、B2、B3是三个驱动移动副与静平台的交点,d1、d2、d3是B1、B2、B3与底部三角形中心的距离,该底部三角形是B1、B2、B3构成的三角形。Specifically, as shown in FIG. 3 , the above formula can be obtained by the following steps: the geometric centers of the three
进一步地,局部坐标系中的点通过如下姿态转换矩阵转换到全局坐标系:Further, the points in the local coordinate system are transformed to the global coordinate system through the following attitude transformation matrix:
其中,、、分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度。in, , , are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively.
进一步地,由于3PPS并联机构绕z轴零扭转,故=0,则姿态转换矩阵可简化为:Further, since the 3P P S parallel mechanism has zero twist around the z-axis, so =0, then the attitude transformation matrix can be simplified as:
进一步地,动平台10上三个球面副34几何中心、、相对于全局坐标系的位置矢量可表示为:Further, the geometric centers of the three
其中,为点在局部坐标系的位置矢量,为P点在全局坐标系的位置矢量。in, for the position vector of the point in the local coordinate system, is the position vector of point P in the global coordinate system.
上式写为齐次变换的表达形式为:The expression above is written as a homogeneous transformation as:
其中,,,,;in, , , , ;
进一步地,由于3PPS并联机构本身的几何约束关系,只能在平面内运动,则Further, due to the geometric constraints of the 3P P S parallel mechanism itself, only in In-plane motion, then
联立以上各式,可求出:Combining the above equations, we can obtain:
,, , ,
进一步地,由,可得:Further, by ,Available:
本发明通过在静平台21的基础上增加了与静平台21相配合的冗余静平台22,形成双层结构,以对支链30中的驱动移动副31进行双层冗余约束,能够有效降低动平台10和静平台21之间的距离,显著提升系统刚度。另外,采用双层结构设计的基座20,适用范围广,也即本发明所采用的设计方式扩大了3PPS并联机构的基座20范围,使得并联机构与其它设备的接口安装更加灵活,不仅可以垂直安装,还可以利用任意一个侧面水平安装。本发明所述的两转一移并联机构还具有结构对称且紧凑、可靠性高、动态性能好、控制简单且精度高的优点。In the present invention, a redundant
进一步的,本发明还提供了一种少自由度并联机器人,其为3PPS并联机器人,并且具有前述的任一种两转一移并联机构。Further, the present invention also provides a parallel robot with few degrees of freedom, which is a 3P P S parallel robot, and has any of the aforementioned two-turn-one-shift parallel mechanisms.
尽管已参考说明性实施例描述了本发明,但所属领域的技术人员将理解,在不背离本发明的精神及范围的情况下可做出各种其它改变、省略及/或添加且可用实质等效物替代所述实施例的元件。另外,可在不背离本发明的范围的情况下做出许多修改以使特定情形或材料适应本发明的教示。因此,本文并不打算将本发明限制于用于执行本发明的所揭示特定实施例,而是打算使本发明将包含归属于所附权利要求书的范围内的所有实施例。Although the present invention has been described with reference to illustrative embodiments, those skilled in the art will understand that various other changes, omissions and/or additions and the like may be made without departing from the spirit and scope of the invention Effects replace elements of the described embodiments. In addition, many modifications may be made to adapt a particular situation or material to the teachings of the invention without departing from its scope. Therefore, it is not intended herein to limit the invention to the particular embodiments disclosed for carrying out the invention, but it is intended that this invention include all embodiments falling within the scope of the appended claims.
Claims (9)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110402920.6A CN112975916B (en) | 2021-04-15 | 2021-04-15 | Two-turn and one-shift parallel mechanism, its end pose determination method and application |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110402920.6A CN112975916B (en) | 2021-04-15 | 2021-04-15 | Two-turn and one-shift parallel mechanism, its end pose determination method and application |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112975916A CN112975916A (en) | 2021-06-18 |
CN112975916B true CN112975916B (en) | 2021-07-30 |
Family
ID=76339806
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110402920.6A Active CN112975916B (en) | 2021-04-15 | 2021-04-15 | Two-turn and one-shift parallel mechanism, its end pose determination method and application |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112975916B (en) |
Families Citing this family (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN220404114U (en) * | 2022-03-07 | 2024-01-30 | 诺创智能医疗科技(杭州)有限公司 | Mechanical arm, robot and minimally invasive surgery robot system |
CN114683249B (en) * | 2022-03-07 | 2024-03-22 | 诺创智能医疗科技(杭州)有限公司 | Pose determining method and device for parallel mechanism |
CN116269783B (en) * | 2023-03-28 | 2023-12-19 | 北京维卓致远医疗科技发展有限责任公司 | Guide frame and surgical robot |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101244558A (en) * | 2008-03-28 | 2008-08-20 | 天津大学 | Parallel mechanism with three rotational degrees of freedom in space |
CN106903677A (en) * | 2017-04-21 | 2017-06-30 | 北京交通大学 | A kind of structural redundancy parallel institution that there is two rotation one to move |
CN107511817A (en) * | 2017-09-12 | 2017-12-26 | 北京工业大学 | A kind of two turn one is moved asymmetric coupling mechanism |
CN110181487A (en) * | 2019-06-26 | 2019-08-30 | 燕山大学 | One kind having two turn of one shift redundancy driven Parallel Kinematic Manipulator of high automaticity |
CN209868599U (en) * | 2019-05-09 | 2019-12-31 | 中国科学院宁波材料技术与工程研究所 | Rigid-flexible hybrid force control end effector driven by gas and electricity |
CN110937093A (en) * | 2019-12-26 | 2020-03-31 | 中国科学院宁波材料技术与工程研究所 | Underwater equipment vector propeller |
-
2021
- 2021-04-15 CN CN202110402920.6A patent/CN112975916B/en active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101244558A (en) * | 2008-03-28 | 2008-08-20 | 天津大学 | Parallel mechanism with three rotational degrees of freedom in space |
CN106903677A (en) * | 2017-04-21 | 2017-06-30 | 北京交通大学 | A kind of structural redundancy parallel institution that there is two rotation one to move |
CN107511817A (en) * | 2017-09-12 | 2017-12-26 | 北京工业大学 | A kind of two turn one is moved asymmetric coupling mechanism |
CN209868599U (en) * | 2019-05-09 | 2019-12-31 | 中国科学院宁波材料技术与工程研究所 | Rigid-flexible hybrid force control end effector driven by gas and electricity |
CN110181487A (en) * | 2019-06-26 | 2019-08-30 | 燕山大学 | One kind having two turn of one shift redundancy driven Parallel Kinematic Manipulator of high automaticity |
CN110937093A (en) * | 2019-12-26 | 2020-03-31 | 中国科学院宁波材料技术与工程研究所 | Underwater equipment vector propeller |
Also Published As
Publication number | Publication date |
---|---|
CN112975916A (en) | 2021-06-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112975916B (en) | Two-turn and one-shift parallel mechanism, its end pose determination method and application | |
US8424411B2 (en) | Parallel robot | |
CN108555889B (en) | Spatial five-degree-of-freedom hybrid processing equipment with redundant constraints and its use method | |
CN103448059B (en) | Containing planar six-rod closed loop side chain 6DOF parallel institution | |
CN106002956B (en) | A kind of Planar Mechanisms self-balancing freedom degree parallel connection platform | |
CN109048987B (en) | Parallel flexible wrist mechanism | |
CN100553898C (en) | A kind of two freedom space parallel mechanism | |
CN102689304B (en) | Three-freedom-degree mobile parallel robot mechanism | |
CN101693366A (en) | 5-DOF (degree of freedom) parallel robot mechanism | |
CN106671062A (en) | Three-translation one-rotation four-degree-of-freedom parallel mechanism | |
CN117124299A (en) | Underwater serial-parallel mechanical arm with motion redundancy | |
CN207592864U (en) | The parallel machine of redundant drive active Planar Mechanisms Three Degree Of Freedom | |
CN106514624B (en) | A kind of restructural four-degree-of-freedparallel parallel manipulator | |
CN205734898U (en) | A kind of two move two rotation four-degree-of-freedom holohedral symmetry parallel institutions | |
CN108858141B (en) | Space two-rotation one-translation redundancy constraint parallel mechanism and working method thereof | |
CN1772444A (en) | A four-degree-of-freedom parallel robot mechanism with two-dimensional translation and two-dimensional rotation | |
CN205915333U (en) | Three degrees of freedom of overconstraint self -balancing platform that connects in parallel | |
CN107511817B (en) | A Two-Transfer One-Shift Asymmetric Coupling Mechanism | |
CN113211417B (en) | Three-translation parallel mechanism | |
CN112571404B (en) | Six-degree-of-freedom decoupling series-parallel mechanism | |
CN207997306U (en) | A kind of 3-dof parallel robot suitable for spherical surface processing | |
CN1178769C (en) | 3-TRT/SPS four-degree-of-freedom space parallel robot mechanism | |
CN116766164B (en) | High-rigidity five-degree-of-freedom parallel driving robot with multi-ring coupling branched chains | |
CN101417423A (en) | 3-2-1 Structure 3D Mobile Industrial Robot | |
CN111438682A (en) | Industrial mobile flip table with two transfers, one transfer and three degrees of freedom |
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 |