[go: up one dir, main page]

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 PDF

Info

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
Application number
CN202110402920.6A
Other languages
Chinese (zh)
Other versions
CN112975916A (en
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.)
Ningbo Institute of Material Technology and Engineering of CAS
Original Assignee
Ningbo Institute of Material Technology and Engineering of CAS
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 Ningbo Institute of Material Technology and Engineering of CAS filed Critical Ningbo Institute of Material Technology and Engineering of CAS
Priority to CN202110402920.6A priority Critical patent/CN112975916B/en
Publication of CN112975916A publication Critical patent/CN112975916A/en
Application granted granted Critical
Publication of CN112975916B publication Critical patent/CN112975916B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/003Programme-controlled manipulators having parallel kinematics
    • B25J9/0033Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base
    • B25J9/0036Programme-controlled manipulators having parallel kinematics with kinematics chains having a prismatic joint at the base with kinematics chains of the type prismatic-rotary-rotary
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1602Programme controls characterised by the control system, structure, architecture
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B25HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25JMANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00Programme-controlled manipulators
    • B25J9/16Programme controls
    • B25J9/1615Programme controls characterised by special kind of manipulator, e.g. planar, scara, gantry, cantilever, space, closed chain, passive/active joints and tendon driven manipulators
    • B25J9/1623Parallel 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

本发明公开了一种两转一移并联机构、其末端位姿确定方法及应用。所述两转一移并联机构包括动平台、基座和三个支链,基座包括静平台、冗余静平台及连接静平台和冗余静平台的多个连接件,冗余静平台位于动平台和静平台之间,且冗余静平台上设有三个通孔,三个支链连接于动平台和静平台之间,每个支链包括驱动移动副、第一被动移动副、第二被动移动副和球面副,每个驱动移动副的一端通过第一被动移动副与静平台可移动地连接,相对端穿过冗余静平台的一通孔后通过对应的球面副与动平台可转动地连接,且驱动移动副还通过第二被动移动副与冗余静平台可移动地连接。本发明能够降低动平台与静平台之间的间距,提高系统刚度。

Figure 202110402920

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.

Figure 202110402920

Description

两转一移并联机构、其末端位姿确定方法及应用Two-turn and one-shift parallel mechanism, its end pose determination method and application

技术领域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:

Figure 8666DEST_PATH_IMAGE001
Figure 8666DEST_PATH_IMAGE001

其中,

Figure 974610DEST_PATH_IMAGE002
Figure 705805DEST_PATH_IMAGE003
Figure 230328DEST_PATH_IMAGE004
分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度,
Figure 312553DEST_PATH_IMAGE005
为三个球面副的几何中心
Figure 315144DEST_PATH_IMAGE006
Figure 369688DEST_PATH_IMAGE007
Figure 360384DEST_PATH_IMAGE008
构成的正三角的外接圆的半径,
Figure 867589DEST_PATH_IMAGE009
为正三角形的外接圆的圆心的坐标值。in,
Figure 974610DEST_PATH_IMAGE002
,
Figure 705805DEST_PATH_IMAGE003
,
Figure 230328DEST_PATH_IMAGE004
are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively,
Figure 312553DEST_PATH_IMAGE005
is the geometric center of the three spherical pairs
Figure 315144DEST_PATH_IMAGE006
,
Figure 369688DEST_PATH_IMAGE007
,
Figure 360384DEST_PATH_IMAGE008
The radius of the circumcircle of the formed regular triangle,
Figure 867589DEST_PATH_IMAGE009
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 platform 10, a base 20 and three branch chains 30. The three branch chains 30 are installed on the base 20 and are connected to the moving platform 10, and the expansion and contraction of the three branch chains 30 are controlled cooperatively. The moving platform 10 can realize the pose transformation of two rotations and one displacement. Specifically, the base 20 includes a static platform 21 , a redundant static platform 22 and a plurality of connectors 23 , the static platform 21 and the redundant static platform 22 are arranged opposite to each other, and the redundant static platform 22 is located between the dynamic platform 10 and the static platform 21 . , and the redundant static platform 22 is provided with three through holes 221, one end of each connecting piece 23 is connected with the static platform 21, and the opposite end is connected with the redundant static platform 22, finally forming a double-layer structure; each branch 30 is connected Between the moving platform 10 and the static platform 21, each branch chain 30 includes a driving moving pair 31, a first passive moving pair 32, a second passive moving pair 33 and a spherical pair 34. One end of the driving moving pair 31 passes through the first passive moving pair 31. The moving pair 32 is movably connected to the static platform 21 , and the opposite end passes through the through hole 221 on the redundant static platform 22 and is rotatably connected to the moving platform 10 through the spherical pair 34 , and the driving moving pair 31 also moves through the second passive movement. The pair 33 is movably connected to the static platform 21 . By adopting the base 20 designed with a double-layer structure, that is, adopting the double-layer structure composed of the static platform 21 and the redundant static platform 22, the double-layer redundant constraint can be applied to the driving moving pair 31 in the branch chain 30, which can reduce the dynamic The distance between the platform 10 and the static platform 21 significantly improves the rigidity of the system, and the distance here refers to the distance between the movable platform 10 and the redundant static platform 22 . The base 20 with the double-layer redundant constraint design is not only suitable for the 3P P S parallel mechanism, but also suitable for other mechanisms using linear drives such as electric push rods and hydraulic cylinders as the driving moving pair 31, and has a wide range of applications.

本实施例中,通孔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 hole 221 is preferably a rectangular hole. Of course, in other embodiments, the shape of the through hole 221 can also be set according to actual requirements, such as a circle or the like. The three branch chains 30 are arranged in an equilateral triangle around the center of the static platform, that is, one end of the branch chain 30 is arranged in an equilateral triangle on the surface of the moving platform 10, and the opposite end is arranged in an equilateral triangle on the static platform 21. The distances from the ends of the two branches to their respective centers are the same, and the included angle between the two adjacent branch chains 30 is 120 degrees. The driving body 31b and the linear driving base 31c, the linear driving body 31b is connected between the linear driving telescopic rod 31a and the linear driving base 31c, and the linear driving body 31b drives the linear telescopic rod to realize telescopic. When implemented, the linear moving mechanism can choose electric push rod, hydraulic cylinder and so on. The three spherical pairs 34 are arranged in an equilateral triangle on the moving platform 10, and the spherical pairs 34 are preferably ball bearings. The ball bearings have a bearing base and a connecting handle that is connected to the bearing base and can be rotated relative to the bearing base. Of course, in other embodiments, You can choose a mechanism with the same function, such as a joint ball joint.

如图1所示,每个第一被动移动副32包括设于静平台21上的至少一个第一滑轨组件,第一滑轨组件用于使驱动移动副31导向移动。具体地,第一滑轨组件包括第一滑块32a和第一导轨32b,第一滑块32a滑动设于第一导轨32b上,第一滑块32a与直线移动机构的直线驱动底座31c通过螺丝相连,第一导轨32b沿静平台21的径向方向延伸设置,用于供第一滑块32a导向移动。As shown in FIG. 1 , each first passive moving pair 32 includes at least one first sliding rail assembly disposed on the static platform 21 , and the first sliding rail assembly is used to guide the driving moving pair 31 to move. Specifically, the first sliding rail assembly includes a first sliding block 32a and a first guide rail 32b, the first sliding block 32a is slidably arranged on the first guide rail 32b, and the first sliding block 32a and the linear driving base 31c of the linear moving mechanism are connected by screws In connection, the first guide rails 32b extend along the radial direction of the static platform 21 for guiding and moving the first sliding block 32a.

本实施例中,三个第一导轨32b中,相邻两个第一导轨32b之间的夹角为120度,当然,在其他实施例中,可根据实际需求进行设置,也可将第一滑块32a设于静平台21上。In this embodiment, among the three first guide rails 32b, the included angle between two adjacent first guide rails 32b is 120 degrees. The sliding block 32 a is arranged on the static platform 21 .

每个第二被动移动副33包括设于冗余静平台22上的至少一个第二滑轨组件,第二滑轨组件用于使驱动移动副31导向移动。具体地,第二滑轨组件包括第二滑块33a和第二导轨33b,第二滑块33a滑动设于第二导轨33b上,第二滑块33a通过法兰40与直线移动机构的直线驱动本体31b相连,第二导轨33b沿冗余静平台22的径向方向延伸设置,用于供第二滑块33a导向移动。Each second passive moving pair 33 includes at least one second sliding rail assembly disposed on the redundant static platform 22 , and the second sliding rail assembly is used to guide the driving moving pair 31 to move. Specifically, the second sliding rail assembly includes a second sliding block 33a and a second guide rail 33b, the second sliding block 33a is slidably arranged on the second guide rail 33b, and the second sliding block 33a is linearly driven by the flange 40 and the linear moving mechanism The main bodies 31b are connected, and the second guide rails 33b are extended along the radial direction of the redundant static platform 22 for guiding and moving the second sliding block 33a.

本实施例中,三个第二导轨33b中,相邻两个第二导轨33b之间的夹角为120度,当然,在其他实施例中,可根据实际需求进行设置,也可将第二滑块33a设于冗余静平台22上。另外,本实施例中,每个第二被动移动副33包括两个第二滑轨组件,每个通孔221的两侧设置对应的两个第二滑轨组件,并且两个第二滑轨组件对称设置。In this embodiment, among the three second guide rails 33b, the included angle between two adjacent second guide rails 33b is 120 degrees. The sliding block 33 a is arranged on the redundant static platform 22 . In addition, in this embodiment, each second passive moving pair 33 includes two second slide rail assemblies, two corresponding second slide rail assemblies are provided on both sides of each through hole 221 , and the two second slide rails Components are set symmetrically.

如图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 passive moving pair 33 on the redundant static platform 22 can be set according to actual requirements. Specifically, the redundant static platform 22 has a first end surface and a second end surface disposed opposite to each other, the first end surface faces the moving platform 10 , and the second end surface faces the static platform 21 . In this embodiment, in each second passive moving pair 33 The second slide rail assembly is arranged on the first end surface of the redundant static platform 22 . As shown in the figure, the second sliding rail assembly in each second passive moving pair 33 is disposed on the first end surface of the redundant static platform 22 , that is, the second sliding rail assembly in each second passive moving pair 33 Located between the redundant static platform 22 and the moving platform 10 . By reasonably setting the position of the second passive moving pair 33 , the distance between the moving platform 10 and the static platform 21 can also be correspondingly reduced.

如图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 platform 10 includes a platform body portion 10a and three lug portions 10b. The platform body portion 10a is entirely cylindrical, and its peripheral side protrudes outward to form three lug portions 10b, two adjacent to each other. The included angle between the center lines of the lug portions 10b is 120 degrees, that is, the three lug portions 10b are distributed at 120 degrees around the body portion. A spherical pair 34 is installed on each lug portion 10b, and each driving moving pair 31 is fixedly connected to a lug portion 10b through the spherical pair 34. In this embodiment, a ball bearing is installed on each lug portion 10b, and each linear movement mechanism is fixedly connected to a lug portion 10b through the ball bearing. The lugs 10b are fixedly connected, and the connecting handle is connected with the end of the linear driving telescopic rod 31a in the linear moving mechanism by means of screw connection.

如图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 static platform 21 is Y-shaped as a whole, and includes a first body portion 21a and three first extension portions 21b. The peripheral surface of the first body portion 21a protrudes outward to form three first extension portions. 21b, the included angle between the centerlines of the two adjacent first extension parts 21b is 120 degrees, that is, the three first extension parts 21b are distributed around the main body at 120 degrees. A first passive moving pair 32 is mounted on each first extending portion 21b, and each driving moving pair 31 is movably connected to the corresponding first extending portion 21b through the first passive moving pair 32. In this embodiment, a first slide rail assembly is installed on each first extension portion 21b, and the linear drive base 31c in each linear movement mechanism is movably connected to the corresponding first extension portion 21b through the first slide rail assembly, Under the action of the first slide rail assembly, the linear drive base 31c can move relative to the corresponding first extension portion 21b. During implementation, the linear drive base 31c is connected to the first slider 32a in the first slide rail assembly through screws. A guide rail is fixedly connected to the corresponding first extension portion 21b by screws.

如图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 static platform 22 is Y-shaped as a whole, and includes a second body portion 22a and three second extension portions 22b. The peripheral side surface of the second body portion 22a protrudes outward to form three second body portions 22a. In the extension portion 22b, the included angle between the centerlines of two adjacent second extension portions 22b is 120 degrees, that is, the three second extension portions 22b are distributed at 120 degrees around the body portion. A second passive moving pair 33 is mounted on each second extending portion 22b, and each driving moving pair 31 is movably connected to the corresponding second extending portion 22b through the second passive moving pair 33. In this embodiment, each second extension portion 22b is provided with a through hole 221 through which the linear drive body 31b passes, and a second slide rail assembly is provided on both sides of the through hole 221. The linear drive body 31b is movably connected to the corresponding second extension portion 22b through the second slide rail assembly. Under the action of the second slide rail assembly, the linear drive body 31b can move relative to the corresponding second extension portion 22b. , the linear drive body 31b is connected with the second sliding block 33a in the second slide rail assembly through the flange 40, and the second guide rail is fixedly connected with the corresponding second extension part 22b through screws.

本发明中动平台10、静平台21及冗余静平台22均为减重优化设计结构,当然,在其他实施例中,也可采用其他形状结构,如圆形结构、三角形结构、正方形结构等等。In the present invention, the moving platform 10 , the static platform 21 and the redundant static platform 22 are all weight-reducing optimized design structures. Of course, in other embodiments, other shapes and structures, such as circular structures, triangular structures, square structures, etc., can also be used. Wait.

实施例二:如图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 platform 10, a base 20 and three branch chains 30, and the three branch chains 30 are installed on the base 20 is connected to the moving platform 10, and the moving platform 10 can realize the pose transformation of two rotations and one displacement by controlling the expansion and contraction of the three branch chains 30 in coordination. Different from the first embodiment, in this embodiment, in each branch chain 30, the second slide rail assembly in each second passive moving pair 33 is arranged on the second end surface of the redundant static platform 22, and also That is, the second sliding rail assembly in each second passive moving pair 33 is located between the static platform 21 and the moving platform 10 .

结合图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 branch chain 30, and calculate the end pose of the two-turn-one-shift parallel mechanism according to the following formula:

Figure 736188DEST_PATH_IMAGE010
Figure 736188DEST_PATH_IMAGE010

其中,

Figure 645238DEST_PATH_IMAGE011
Figure 308301DEST_PATH_IMAGE012
Figure 804266DEST_PATH_IMAGE013
分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度,
Figure 414239DEST_PATH_IMAGE014
为三个球面副34的几何中心
Figure 240113DEST_PATH_IMAGE015
Figure 11760DEST_PATH_IMAGE016
Figure 759136DEST_PATH_IMAGE017
构成的正三角形的外接圆的半径,
Figure 969537DEST_PATH_IMAGE009
为正三角形的外接圆的圆心的坐标值。in,
Figure 645238DEST_PATH_IMAGE011
,
Figure 308301DEST_PATH_IMAGE012
,
Figure 804266DEST_PATH_IMAGE013
are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively,
Figure 414239DEST_PATH_IMAGE014
is the geometric center of the three spherical pairs 34
Figure 240113DEST_PATH_IMAGE015
,
Figure 11760DEST_PATH_IMAGE016
,
Figure 759136DEST_PATH_IMAGE017
The radius of the circumcircle of the formed equilateral triangle,
Figure 969537DEST_PATH_IMAGE009
It is the coordinate value of the center of the circumcircle of the equilateral triangle.

具体地,如图3所示,上述公式可以通过如下步骤获得:三个球面副34的几何中心

Figure 80276DEST_PATH_IMAGE015
Figure 350721DEST_PATH_IMAGE016
Figure 54234DEST_PATH_IMAGE017
构成一个正三角形,该正三角形的外接圆半径为
Figure 6010DEST_PATH_IMAGE014
,以正三角形
Figure 806476DEST_PATH_IMAGE018
的外接圆圆心P为原点建立局部坐标系
Figure 919925DEST_PATH_IMAGE019
,其中
Figure 877779DEST_PATH_IMAGE020
Figure 429983DEST_PATH_IMAGE021
共线且
Figure 22638DEST_PATH_IMAGE022
轴的正方向与
Figure 838148DEST_PATH_IMAGE023
同向,
Figure 578571DEST_PATH_IMAGE020
Figure 606570DEST_PATH_IMAGE024
平行且
Figure 614583DEST_PATH_IMAGE025
的正方向与
Figure 600994DEST_PATH_IMAGE026
同向,
Figure 766396DEST_PATH_IMAGE027
的方向根据右手定则确定。以静平台21的几何中心
Figure 660403DEST_PATH_IMAGE028
为原点建立全局坐标系
Figure 962071DEST_PATH_IMAGE029
,全局坐标系坐标轴的方向与局部坐标系一致。该图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 spherical pairs 34
Figure 80276DEST_PATH_IMAGE015
,
Figure 350721DEST_PATH_IMAGE016
,
Figure 54234DEST_PATH_IMAGE017
form an equilateral triangle whose circumcircle radius is
Figure 6010DEST_PATH_IMAGE014
, in an equilateral triangle
Figure 806476DEST_PATH_IMAGE018
The center of the circumcircle P is the origin to establish a local coordinate system
Figure 919925DEST_PATH_IMAGE019
,in
Figure 877779DEST_PATH_IMAGE020
and
Figure 429983DEST_PATH_IMAGE021
collinear and
Figure 22638DEST_PATH_IMAGE022
The positive direction of the axis is the same as
Figure 838148DEST_PATH_IMAGE023
In the same direction,
Figure 578571DEST_PATH_IMAGE020
and
Figure 606570DEST_PATH_IMAGE024
parallel and
Figure 614583DEST_PATH_IMAGE025
positive direction with
Figure 600994DEST_PATH_IMAGE026
In the same direction,
Figure 766396DEST_PATH_IMAGE027
The direction is determined according to the right-hand rule. Taking the geometric center of the static platform 21
Figure 660403DEST_PATH_IMAGE028
Establish a global coordinate system for the origin
Figure 962071DEST_PATH_IMAGE029
, the direction of the global coordinate system coordinate axis is consistent with the local coordinate system. In Fig. 3, q1, q2, q3 are the elongation of the three driving moving pairs, B1, B2, B3 are the intersection points of the three driving moving pairs and the static platform, d1, d2, d3 are B1, B2, B3 and the The distance from the center of the bottom triangle, which is the triangle formed by B1, B2, and B3.

进一步地,局部坐标系中的点通过如下姿态转换矩阵转换到全局坐标系:Further, the points in the local coordinate system are transformed to the global coordinate system through the following attitude transformation matrix:

Figure 119383DEST_PATH_IMAGE030
Figure 119383DEST_PATH_IMAGE030

其中,

Figure 335863DEST_PATH_IMAGE011
Figure 705664DEST_PATH_IMAGE012
Figure 189735DEST_PATH_IMAGE031
分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度。in,
Figure 335863DEST_PATH_IMAGE011
,
Figure 705664DEST_PATH_IMAGE012
,
Figure 189735DEST_PATH_IMAGE031
are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively.

进一步地,由于3PPS并联机构绕z轴零扭转,故

Figure 517949DEST_PATH_IMAGE031
=0,则姿态转换矩阵可简化为:Further, since the 3P P S parallel mechanism has zero twist around the z-axis, so
Figure 517949DEST_PATH_IMAGE031
=0, then the attitude transformation matrix can be simplified as:

Figure 392364DEST_PATH_IMAGE032
Figure 392364DEST_PATH_IMAGE032

进一步地,动平台10上三个球面副34几何中心

Figure 398147DEST_PATH_IMAGE015
Figure 674407DEST_PATH_IMAGE016
Figure 970259DEST_PATH_IMAGE017
相对于全局坐标系的位置矢量可表示为:Further, the geometric centers of the three spherical pairs 34 on the moving platform 10
Figure 398147DEST_PATH_IMAGE015
,
Figure 674407DEST_PATH_IMAGE016
,
Figure 970259DEST_PATH_IMAGE017
The position vector relative to the global coordinate system can be expressed as:

Figure 331971DEST_PATH_IMAGE033
Figure 331971DEST_PATH_IMAGE033

其中,

Figure 105891DEST_PATH_IMAGE034
Figure 502238DEST_PATH_IMAGE035
点在局部坐标系的位置矢量,
Figure 470456DEST_PATH_IMAGE036
为P点在全局坐标系的位置矢量。in,
Figure 105891DEST_PATH_IMAGE034
for
Figure 502238DEST_PATH_IMAGE035
the position vector of the point in the local coordinate system,
Figure 470456DEST_PATH_IMAGE036
is the position vector of point P in the global coordinate system.

上式写为齐次变换的表达形式为:The expression above is written as a homogeneous transformation as:

Figure 319463DEST_PATH_IMAGE037
Figure 319463DEST_PATH_IMAGE037

其中,

Figure 897075DEST_PATH_IMAGE038
Figure 147928DEST_PATH_IMAGE039
Figure 988845DEST_PATH_IMAGE040
Figure 886000DEST_PATH_IMAGE041
;in,
Figure 897075DEST_PATH_IMAGE038
,
Figure 147928DEST_PATH_IMAGE039
,
Figure 988845DEST_PATH_IMAGE040
,
Figure 886000DEST_PATH_IMAGE041
;

进一步地,由于3PPS并联机构本身的几何约束关系,

Figure 204986DEST_PATH_IMAGE042
只能在
Figure 372662DEST_PATH_IMAGE043
平面内运动,则Further, due to the geometric constraints of the 3P P S parallel mechanism itself,
Figure 204986DEST_PATH_IMAGE042
only in
Figure 372662DEST_PATH_IMAGE043
In-plane motion, then

Figure 384481DEST_PATH_IMAGE044
Figure 384481DEST_PATH_IMAGE044

联立以上各式,可求出:Combining the above equations, we can obtain:

Figure 942501DEST_PATH_IMAGE045
Figure 127495DEST_PATH_IMAGE046
Figure 588825DEST_PATH_IMAGE047
Figure 942501DEST_PATH_IMAGE045
,
Figure 127495DEST_PATH_IMAGE046
,
Figure 588825DEST_PATH_IMAGE047

进一步地,由

Figure 771545DEST_PATH_IMAGE048
,可得:Further, by
Figure 771545DEST_PATH_IMAGE048
,Available:

Figure 144758DEST_PATH_IMAGE049
Figure 144758DEST_PATH_IMAGE049

本发明通过在静平台21的基础上增加了与静平台21相配合的冗余静平台22,形成双层结构,以对支链30中的驱动移动副31进行双层冗余约束,能够有效降低动平台10和静平台21之间的距离,显著提升系统刚度。另外,采用双层结构设计的基座20,适用范围广,也即本发明所采用的设计方式扩大了3PPS并联机构的基座20范围,使得并联机构与其它设备的接口安装更加灵活,不仅可以垂直安装,还可以利用任意一个侧面水平安装。本发明所述的两转一移并联机构还具有结构对称且紧凑、可靠性高、动态性能好、控制简单且精度高的优点。In the present invention, a redundant static platform 22 matched with the static platform 21 is added on the basis of the static platform 21 to form a double-layer structure, so as to carry out double-layer redundant constraints on the driving moving pair 31 in the branch chain 30, which can effectively The distance between the moving platform 10 and the static platform 21 is reduced, and the rigidity of the system is significantly improved. In addition, the base 20 designed with a double-layer structure has a wide range of applications, that is, the design method adopted in the present invention expands the range of the base 20 of the 3P P S parallel mechanism, making the interface installation of the parallel mechanism and other equipment more flexible, Not only can it be installed vertically, it can also be installed horizontally using either side. The two-transfer-one-transfer parallel mechanism of the present invention also has the advantages of symmetrical and compact structure, high reliability, good dynamic performance, simple control and high precision.

进一步的,本发明还提供了一种少自由度并联机器人,其为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)

1.一种两转一移并联机构,其特征在于:所述两转一移并联机构包括动平台、基座和三个支链;所述基座包括静平台、冗余静平台及连接所述静平台和冗余静平台的多个连接件,所述冗余静平台位于所述动平台和静平台之间,且所述冗余静平台上设有三个通孔;三个所述的支链连接于所述动平台和静平台之间,每个所述支链包括驱动移动副、第一被动移动副、第二被动移动副和球面副,每个驱动移动副的一端通过第一被动移动副与静平台可移动地连接,相对端穿过冗余静平台的一通孔后通过对应的球面副与动平台可转动地连接,且所述驱动移动副还通过第二被动移动副与冗余静平台可移动地连接;1. a two-transfer-one-transfer parallel mechanism is characterized in that: the two-transfer-one-transfer parallel mechanism includes a moving platform, a base and three branch chains; the base includes a static platform, a redundant static platform and a connection place. A plurality of connectors of 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; The branch chain is 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 passive moving pair and a spherical surface pair, and one end of each driving moving pair passes through the first The passive moving pair is movably connected to the static platform, the opposite end passes through a through hole of the redundant static platform and is rotatably connected to the moving platform through the corresponding spherical pair, and the driving moving pair is also connected to the moving platform through the second passive moving pair. Redundant static platforms are movably connected; 所述第一被动移动副包括至少一个用于使驱动移动副导向移动的第一滑轨组件,所述第一滑轨组件包括第一滑块及供第一滑块导向移动的第一导轨,所述第一滑块滑动设于所述第一导轨上,所述第一滑块和第一导轨中的任意一个固定于静平台上,另一个与驱动移动副相连;The first passive moving pair includes at least one first sliding rail assembly for guiding and moving the driving moving pair, the first sliding rail assembly includes a first sliding block and a first guide rail for guiding and moving the first sliding block, 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; 所述第二被动移动副包括至少一个用于使驱动移动副导向移动的第二滑轨组件,所述第二滑轨组件包括第二滑块及供第二滑块导向移动的第二导轨,所述第二滑块滑动设于所述第二导轨上,所述第二滑块和第二导轨中的任意一个固定于冗余静平台上,另一个与驱动移动副相连。The second passive moving pair includes at least one second sliding rail assembly for guiding and moving the driving moving pair, the second sliding rail assembly includes a second sliding block and a second guide rail for guiding and moving the second sliding block, 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 with the driving moving pair. 2.根据权利要求1所述的两转一移并联机构,其特征在于,所述第二滑轨组件设于所述冗余静平台上,且位于所述冗余静平台和动平台之间;或者,所述第二滑轨组件设于所述冗余静平台上,且位于所述冗余静平台和静平台之间。2 . The two-turn-one-shift parallel mechanism according to claim 1 , wherein the second slide rail assembly is arranged on the redundant static platform and is located between the redundant static platform and the moving platform. 3 . ; or, the second slide rail assembly is arranged on the redundant static platform, and is located between the redundant static platform and the static platform. 3.根据权利要求1所述的两转一移并联机构,其特征在于,所述第二被动移动副包括两个第二滑轨组件,所述通孔的两侧设置一所述第二滑轨组件,且两个所述第二滑轨组件对称设置。3 . The parallel mechanism of two rotations and one shift according to claim 1 , wherein the second passive moving pair comprises two second sliding rail assemblies, and one second sliding rail assembly is arranged on both sides of the through hole. 4 . rail assemblies, and the two second slide rail assemblies are symmetrically arranged. 4.根据权利要求1所述的两转一移并联机构,其特征在于,三个所述支链的一端在动平台的表面排布成正三角形,相对端在静平台上排布成正三角形。4 . The two-turn-one-shift parallel mechanism according to claim 1 , wherein one end of the three branch chains is arranged in a regular triangle on the surface of the moving platform, and the opposite ends are arranged in a regular triangle on the static platform. 5 . 5.根据权利要求1所述的两转一移并联机构,其特征在于,所述动平台包括平台本体部和三个凸耳部,所述平台本体部的周侧面向外凸起延伸形成三个所述凸耳部,相邻两个所述凸耳部的中心线夹角为120度。5 . The parallel mechanism for two rotations and one shift according to claim 1 , wherein the moving platform comprises a platform body portion and three lug portions, and the peripheral surface of the platform body portion protrudes outward to form three lugs. 6 . There are two said lug portions, and the included angle between the center lines of two adjacent said lug portions is 120 degrees. 6.根据权利要求1所述的两转一移并联机构,其特征在于,所述静平台包括第一本体部和三个第一延伸部,第一本体部的周侧面向外凸起延伸形成三个第一延伸部,相邻两个第一延伸部的中心线夹角为120度。6 . The two-turn-one-shift parallel mechanism according to claim 1 , wherein the static platform comprises a first body part and three first extension parts, and the peripheral surface of the first body part protrudes outwardly to form an extension. 7 . For the three first extension parts, the included angle between the center lines of two adjacent first extension parts is 120 degrees. 7.根据权利要求1所述的两转一移并联机构,其特征在于,所述冗余静平台包括第二本体部和三个第二延伸部,第二本体部的周侧面向外凸起延伸形成三个第二延伸部,相邻两个第二延伸部的中心线夹角为120度。7 . The two-turn-one-shift parallel mechanism according to claim 1 , wherein the redundant static platform comprises a second body part and three second extension parts, and the peripheral surface of the second body part protrudes outward. 8 . Three second extension parts are formed by extension, and the included angle between the center lines of two adjacent second extension parts is 120 degrees. 8.一种基于权利要求1~7任意一项所述的两转一移并联机构的末端位姿确定方法,包括如下步骤:8. A method for determining the terminal position and orientation of the two-transfer-one-transfer parallel mechanism based on any one of claims 1 to 7, comprising the steps of: 获取每个支链的伸长量,并根据如下公式计算两转一移并联机构的末端位姿: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:
Figure DEST_PATH_IMAGE001
Figure DEST_PATH_IMAGE001
其中,
Figure DEST_PATH_IMAGE003
Figure DEST_PATH_IMAGE005
Figure DEST_PATH_IMAGE007
分别为局部坐标系绕全局坐标系x、y、z轴旋转的角度,
Figure DEST_PATH_IMAGE009
为三个球面副的几何中心
Figure DEST_PATH_IMAGE011
Figure DEST_PATH_IMAGE013
Figure DEST_PATH_IMAGE015
构成的正三角的外接圆的半径,
Figure DEST_PATH_IMAGE017
为正三角形的外接圆的圆心的坐标值。
in,
Figure DEST_PATH_IMAGE003
,
Figure DEST_PATH_IMAGE005
,
Figure DEST_PATH_IMAGE007
are the rotation angles of the local coordinate system around the x, y, and z axes of the global coordinate system, respectively,
Figure DEST_PATH_IMAGE009
is the geometric center of the three spherical pairs
Figure DEST_PATH_IMAGE011
,
Figure DEST_PATH_IMAGE013
,
Figure DEST_PATH_IMAGE015
The radius of the circumcircle of the formed regular triangle,
Figure DEST_PATH_IMAGE017
It is the coordinate value of the center of the circumcircle of the equilateral triangle.
9.一种少自由度并联机器人,其特征在于包括权利要求1~7任意一项所述的两转一移并联机构。9 . A parallel robot with few degrees of freedom, characterized in that it comprises the two-turn-one-shift parallel mechanism according to any one of claims 1 to 7 .
CN202110402920.6A 2021-04-15 2021-04-15 Two-turn and one-shift parallel mechanism, its end pose determination method and application Active CN112975916B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

Patent Citations (6)

* Cited by examiner, † Cited by third party
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