[go: up one dir, main page]

CN110076754B - Mobile parallel mechanism with multiple motion modes and control method thereof - Google Patents

Mobile parallel mechanism with multiple motion modes and control method thereof Download PDF

Info

Publication number
CN110076754B
CN110076754B CN201910352735.3A CN201910352735A CN110076754B CN 110076754 B CN110076754 B CN 110076754B CN 201910352735 A CN201910352735 A CN 201910352735A CN 110076754 B CN110076754 B CN 110076754B
Authority
CN
China
Prior art keywords
lower platform
platform
pair
steering engines
parallel mechanism
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
CN201910352735.3A
Other languages
Chinese (zh)
Other versions
CN110076754A (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.)
Shanghai University of Engineering Science
Original Assignee
Shanghai University of Engineering Science
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 University of Engineering Science filed Critical Shanghai University of Engineering Science
Priority to CN201910352735.3A priority Critical patent/CN110076754B/en
Publication of CN110076754A publication Critical patent/CN110076754A/en
Application granted granted Critical
Publication of CN110076754B publication Critical patent/CN110076754B/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/0045Programme-controlled manipulators having parallel kinematics with kinematics chains having a rotary joint at the base

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)
  • Forklifts And Lifting Vehicles (AREA)

Abstract

本发明属于运动控制的技术领域,公开了一种多运动模式的移动并联机构,包括平行四边形结构的上平台和下平台,所述上平台与下平台平行设置,两者之间设置有多条支链,多条所述支链彼此平行设置,包括三个转动副和一个移动副,其首尾端通过舵机与上平台和下平台相连,所有所述转动副的转动轴的轴向中心线均相互平行,且与上平台或者下平台的同一边平行。还公开了一种多运动模式的移动并联机构的控制方法,通过多个所述舵机控制对应的第一转动副、第二转动副的转动,带动对应的第三转动副的转动,从而控制对应支链不断地弯曲和拉直,实现上平台和下平台的交替着地,进而实现移动并联机构的滚动模式。

Figure 201910352735

The invention belongs to the technical field of motion control, and discloses a moving parallel mechanism with multiple motion modes, comprising an upper platform and a lower platform in a parallelogram structure, the upper platform and the lower platform are arranged in parallel, and a plurality of Branch chains, a plurality of the branch chains are arranged in parallel with each other, including three rotating pairs and one moving pair, the head and tail ends of which are connected with the upper platform and the lower platform through the steering gear, and the axial centerlines of the rotating shafts of all the rotating pairs They are all parallel to each other and parallel to the same side of the upper or lower platform. Also disclosed is a control method for a moving parallel mechanism in a multi-movement mode. The rotation of the corresponding first rotation pair and the second rotation pair is controlled by a plurality of the steering gears, and the rotation of the corresponding third rotation pair is driven, thereby controlling the rotation of the corresponding third rotation pair. The corresponding branch chain is continuously bent and straightened to realize the alternate landing of the upper platform and the lower platform, thereby realizing the rolling mode of the mobile parallel mechanism.

Figure 201910352735

Description

一种多运动模式的移动并联机构及其控制方法A kind of moving parallel mechanism with multi-motion mode and its control method

技术领域technical field

本发明涉及运动控制的技术领域,尤其涉及一种多运动模式的移动并联机构及其控制方法。The present invention relates to the technical field of motion control, and in particular, to a moving parallel mechanism with multiple motion modes and a control method thereof.

背景技术Background technique

随着机器人的发展热潮,移动机器人已经应用于很多领域,例如抢险救灾、太空探索、军事侦察、以及自主排爆等自主作业任务,作业环境往往是平坦与崎岖共存的多重特征任务环境,单一运动方式的机器人已无法适应复杂多变的环境,因此,多模式移动机构是当今移动机器人发展的需求。With the development of robots, mobile robots have been used in many fields, such as rescue and disaster relief, space exploration, military reconnaissance, and autonomous operation tasks such as autonomous detonation. Therefore, the multi-mode mobile mechanism is the demand for the development of today's mobile robots.

目前,将多种移动方式如全姿态滚动、四足行走在同一个机构上集成和切换的机构,如美国NASA资助研制了“丹蒂”八足行走机器人,波士顿动力公司研制了一种四足机器人BigDog,虽然以上机器人具有多种运动模式,但其以模块化自重构方式实现多运动模式,具有控制复杂、刚度、精度不足以及稳定性较差等缺点。此外,由于并联机构具有刚度高、精度高、承载力大的特点及其固有属性,将其应用于多模式移动机构中的研究很少,因此,开发一种刚度好且控制简单的多模式步滚移动并联机构极具现实意义。At present, a mechanism that integrates and switches a variety of moving methods such as full-position rolling and four-legged walking on the same mechanism, such as the "Danti" eight-legged walking robot funded by NASA in the United States, and a four-legged walking robot developed by Boston Dynamics Robot BigDog, although the above robots have multiple motion modes, they realize multi-motion modes in a modular self-reconfiguration method, which has the disadvantages of complex control, insufficient stiffness, insufficient precision, and poor stability. In addition, due to the characteristics of high stiffness, high precision, large bearing capacity and its inherent properties of parallel mechanisms, there are few studies on their application in multi-mode moving mechanisms. Therefore, the development of a multi-mode step with good stiffness and simple control Rolling and moving parallel mechanism is of great practical significance.

发明内容SUMMARY OF THE INVENTION

本发明提供了一种多运动模式的移动并联机构及控制方法,解决了现有多运动模式的机器人,控制复杂、刚度、精度不足以及稳定性较差等问题。The invention provides a multi-movement mode mobile parallel mechanism and a control method, and solves the problems of the existing multi-movement mode robot, such as complex control, insufficient rigidity, precision and poor stability.

本发明可通过以下技术方案实现:The present invention can be realized through the following technical solutions:

一种多运动模式的移动并联机构,包括平行四边形结构的上平台和下平台,所述上平台与下平台平行设置,两者之间设置有多条支链,多条所述支链彼此平行设置,包括三个转动副和一个移动副,其首尾端通过舵机与上平台和下平台相连,所有所述转动副的转动轴的轴向中心线均相互平行,且与上平台或者下平台的同一边平行。A moving parallel mechanism with multi-movement mode, comprising an upper platform and a lower platform of a parallelogram structure, the upper platform and the lower platform are arranged in parallel, a plurality of branch chains are arranged between the two, and the plurality of the branch chains are parallel to each other Set, including three rotating pairs and one moving pair, the head and tail ends of which are connected to the upper platform and the lower platform through the steering gear, and the axial centerlines of the rotating shafts of all the rotating pairs are parallel to each other, and the upper platform or the lower platform. parallel to the same side.

进一步,所述舵机设置有多个,分布设置在上平台和下平台相对的一面的四个角上,所述上平台的舵机与支链首端的第一转动副相连,所述下平台的舵机与支链尾端的第二转动副相连,所述第一转动副通过移动副与第三转动副相连,所述第三转动副通过连杆与第二转动副相连。Further, the steering gear is provided with a plurality of them, which are distributed on the four corners of the opposite side of the upper platform and the lower platform. The steering gear of the upper platform is connected with the first rotating pair at the head end of the branch chain, and the lower platform The steering gear is connected with the second rotating pair at the tail end of the branch chain, the first rotating pair is connected with the third rotating pair through the moving pair, and the third rotating pair is connected with the second rotating pair through the connecting rod.

进一步,所述移动副设置为电动伸缩杆。Further, the moving pair is configured as an electric telescopic rod.

一种基于上文所述的多运动模式的移动并联机构的控制方法,利用设置在上平台和下平台上的多个舵机之间的协同作业控制多条支链的运动,实现移动并联机构的滚动、行走和越障模式及其模式之间的切换。A control method for a mobile parallel mechanism based on the multi-motion mode described above, utilizes the cooperative operation between a plurality of steering gears arranged on an upper platform and a lower platform to control the movement of a plurality of branch chains, and realizes a mobile parallel mechanism. Rolling, Walking and Obstacle Crossing modes and switching between modes.

进一步,通过多个所述舵机控制对应的第一转动副、第二转动副的转动,带动对应的第三转动副的转动,从而控制对应支链不断地弯曲和拉直,实现上平台和下平台的交替着地,进而实现移动并联机构的滚动模式。Further, the rotation of the corresponding first rotation pair and the second rotation pair is controlled by a plurality of the steering gears, and the rotation of the corresponding third rotation pair is driven, thereby controlling the corresponding branch chain to bend and straighten continuously, so as to realize the upper platform and the The alternate landing of the lower platform realizes the rolling mode of the mobile parallel mechanism.

进一步,滚动模式的控制方法包括以下步骤:Further, the control method of the scroll mode includes the following steps:

将所述上平台的四个舵机依次顺时标记为M1、M2、M3和M4,对应舵机M1、M2、M3和M4,所述下平台的四个舵机依次标记为M5、M6、M7和M8,滚动模式的初始状态设置为锁定四个移动副,下平台着地,与之相连的四个支链垂直于上平台和下平台站立,Mark the four steering gears of the upper platform as M1, M2, M3 and M4 in turn, corresponding to the steering gears M1, M2, M3 and M4, and mark the four steering gears of the lower platform as M5, M6, For M7 and M8, the initial state of the rolling mode is set to lock the four moving pairs, the lower platform is on the ground, and the four branches connected to it stand perpendicular to the upper and lower platforms,

步骤一、通过舵机M5、M6、M7和M8控制对应的第二转动副向滚动方向同时转动,带动对应的第三转动副同时转动,使对应的连杆与移动副之间产生夹角,直至整个移动并联机构的重心超过下平台的边界;Step 1. Control the corresponding second rotating pair to rotate in the rolling direction simultaneously through the steering gears M5, M6, M7 and M8, and drive the corresponding third rotating pair to rotate at the same time, so as to generate an included angle between the corresponding connecting rod and the moving pair, Until the center of gravity of the entire mobile parallel mechanism exceeds the boundary of the lower platform;

步骤二、通过舵机M1、M2、M3和M4控制对应的第一转动副向滚动方向同时转动,带动对应的第三转动副同时转动,直至对应的连杆与移动副处于同一直线上;Step 2: Control the corresponding first rotating pair to rotate simultaneously in the rolling direction through the steering gears M1, M2, M3 and M4, and drive the corresponding third rotating pair to rotate at the same time, until the corresponding connecting rod and the moving pair are on the same straight line;

步骤三、通过舵机M1、M2与舵机M5、M6或舵机M3、M4与舵机M7、M8控制对应的第一转动副、第二转动副向滚动方向同时转动,带动舵机M3、M4与舵机M7、M8或者舵机M1、M2与舵机M5、M6对应第一转动副、第二转动副向滚动方向同时转动,直至整个移动并联机构的重心超过上平台的中心,从而使上平台着地,与之相连的四个支链垂直于上平台和下平台站立;Step 3. The first and second rotation pairs controlled by the steering gears M1 and M2 and the steering gears M5 and M6 or the steering gears M3 and M4 and the steering gears M7 and M8 are simultaneously rotated in the rolling direction, so as to drive the steering gears M3 and M8. M4 and steering gears M7, M8 or steering gears M1, M2 and steering gears M5, M6 rotate simultaneously in the rolling direction corresponding to the first rotation pair and the second rotation pair, until the center of gravity of the entire moving parallel mechanism exceeds the center of the upper platform, so that the The upper platform is on the ground, and the four branches connected to it stand perpendicular to the upper platform and the lower platform;

步骤四、重复步骤一至三,使下平台着地,与之相连的四个支链垂直于上平台和下平台站立;Step 4. Repeat steps 1 to 3 to make the lower platform touch the ground, and the four branches connected to it stand perpendicular to the upper platform and the lower platform;

步骤五、重复步骤一至四,使上平台、下平台交替着地,完成移动并联机构的滚动模式。Step 5: Repeat steps 1 to 4 to make the upper platform and the lower platform land alternately to complete the rolling mode of the mobile parallel mechanism.

进一步,所述步骤一中通过舵机M5、M6、M7和M8控制对应的第二转动副的转动角度设置为45度;通过舵机M1、M2与舵机M5、M6或舵机M3、M4与舵机M7、M8控制对应的第一转动副、第二转动副向滚动方向同时转动,直至上平台与地面的夹角小于30度。Further, in the step 1, the rotation angle of the corresponding second rotation pair controlled by the steering gears M5, M6, M7 and M8 is set to 45 degrees; by the steering gears M1, M2 and the steering gears M5, M6 or the steering gears M3, M4 The first rotation pair and the second rotation pair corresponding to the control of the steering gears M7 and M8 rotate simultaneously in the rolling direction until the angle between the upper platform and the ground is less than 30 degrees.

进一步,通过设置在所述下平台上的多个舵机控制对应的第二转动副同时转动,带动对应的第三转动副、第一转动副的转动,使对应的连杆与移动副连接处着地,形成四足结构,再通过所述下平台上的多个舵机控制对应的第三转动副逐个抬起、落地,实现移动并联机构的行走模式;再通过所述下平台上的多个舵机控制对应的第三转动副逐个抬起、落地以及对应移动副的伸长和缩短,实现移动并联机构的越障模式。Further, through the plurality of steering gears arranged on the lower platform, the corresponding second rotation pairs are controlled to rotate at the same time, and the corresponding third rotation pairs and the first rotation pairs are driven to rotate, so that the corresponding connecting rods are connected with the moving pair. Land on the ground to form a four-legged structure, and then control the corresponding third rotating pairs to lift and land one by one through the plurality of steering gears on the lower platform, so as to realize the walking mode of the mobile parallel mechanism; The steering gear controls the corresponding third rotating pair to lift and land one by one, as well as to extend and shorten the corresponding moving pair, so as to realize the obstacle-crossing mode of the mobile parallel mechanism.

进一步,行走模式的控制方法包括以下步骤:Further, the control method of the walking mode includes the following steps:

将所述上平台的四个舵机依次顺时标记为M1、M2、M3和M4,对应舵机M1、M2、M3和M4,所述下平台的四个舵机依次标记为M5、M6、M7和M8,行走模式的初始状态设置为锁定四个移动副,舵机M5、M6、M7和M8控制对应的第二转动副同时向下转动120度,使下平台整体上抬,对应的连杆与移动副连接处着地站立,所述连接处依次标记为a、b、c、d,移动并联机构重心的初始位置处于机构的几何中心,Mark the four steering gears of the upper platform as M1, M2, M3 and M4 in turn, corresponding to the steering gears M1, M2, M3 and M4, and mark the four steering gears of the lower platform as M5, M6, For M7 and M8, the initial state of the walking mode is set to lock the four moving pairs. The steering gears M5, M6, M7 and M8 control the corresponding second rotating pair to rotate 120 degrees downward at the same time, so that the lower platform is lifted as a whole, and the corresponding connecting Stand on the ground at the connection between the rod and the moving pair, the connection is marked as a, b, c, d in turn, the initial position of the center of gravity of the mobile parallel mechanism is at the geometric center of the mechanism,

步骤Ⅰ、通过舵机M5控制对应的第二转动副向下平台的内侧转动设定角度,使连接处a沿地面向下平台的内侧移动,连接处b朝行进方向抬起;Step 1, control the corresponding second rotation pair to turn the set angle on the inner side of the downward platform through the steering gear M5, so that the connection part a moves down the inner side of the platform along the ground, and the connection part b is lifted toward the traveling direction;

步骤Ⅱ、通过舵机M8控制对应的第二转动副向下平台的内侧转动设定角度,使连接处d沿地面向下平台的内侧移动,移动并联机构的重心沿行进方向超过初始位置,连接处b落地,连接处d抬起;Step II: Control the corresponding second rotation pair to rotate downward to the inner side of the platform to set the angle through the steering gear M8, so that the connection point d moves down the inner side of the platform along the ground, and the center of gravity of the moving parallel mechanism exceeds the initial position along the traveling direction, and the connection The place b falls to the ground, and the connection d lifts up;

步骤Ⅲ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b沿地面向下平台的内侧移动,连接处d落地,连接处a朝行进方向抬起;Step III: Control the corresponding second rotation pair to turn the set angle downwards to the inside of the platform through the steering gear M6, so that the connection b moves down the inner side of the platform along the ground, the connection d falls to the ground, and the connection a lifts up in the direction of travel ;

步骤Ⅳ、通过舵机M7控制对应的第二转动副向下平台的内侧转动设定角度,使连接处c沿地面向下平台的内侧移动,移动并联机构的重心沿行进方向超过初始位置,连接处a落地,带动整个移动并联机构向行进方向移动;Step IV, control the corresponding second rotation pair to turn the set angle downwards on the inner side of the platform through the steering gear M7, so that the connection c moves down the inner side of the platform along the ground, and the center of gravity of the moving parallel mechanism exceeds the initial position along the travel direction, and the connection is made. Landing at a, driving the entire mobile parallel mechanism to move in the direction of travel;

步骤Ⅴ、通过舵机M5、M6、M7和M8控制对应的第二转动副同时下平台的内侧转动相同的设定角度,使移动并联机构回复初始状态;Step Ⅴ: Control the corresponding second rotation pair through the steering gears M5, M6, M7 and M8 and simultaneously lower the inner side of the platform to rotate the same set angle, so that the mobile parallel mechanism returns to the initial state;

步骤Ⅵ、重复步骤Ⅰ至Ⅴ,使移动并联机构始终处于行走状态。Step VI, repeat steps I to V, so that the mobile parallel mechanism is always in the walking state.

进一步,越障模式的控制方法包括以下步骤:Further, the control method of the obstacle crossing mode includes the following steps:

将所述上平台的四个舵机依次顺时标记为M1、M2、M3和M4,对应舵机M1、M2、M3和M4,所述下平台的四个舵机依次标记为M5、M6、M7和M8,越障模式的初始状态设置为舵机M5、M6、M7和M8控制对应的第二转动副同时向下转动120度,使下平台整体上抬,对应的连杆与移动副连接处着地站立,所述连接处依次标记为a、b、c、d,连接处a、b靠近障碍物,Mark the four steering gears of the upper platform as M1, M2, M3 and M4 in turn, corresponding to the steering gears M1, M2, M3 and M4, and mark the four steering gears of the lower platform as M5, M6, M7 and M8, the initial state of obstacle crossing mode is set as the second rotating pair corresponding to the steering gear M5, M6, M7 and M8 control and rotate 120 degrees downward at the same time, so that the lower platform is lifted as a whole, and the corresponding connecting rod is connected with the moving pair Standing on the ground, the connection points are marked as a, b, c, d in turn, and the connection points a and b are close to the obstacle,

步骤ⅰ、通过舵机M5控制对应的第二转动副向下平台的内侧转动设定角度,使连接处a沿地面向下平台的内侧移动,连接处b向上抬起同时对应的移动副缩短,与障碍物的顶部接触;Step 1. Control the corresponding second rotation pair to rotate downward to the inner side of the platform through the steering gear M5 to set the angle, so that the connection point a moves down the inner side of the platform along the ground, and the connection point b is lifted up and the corresponding moving pair is shortened. contact with the top of the obstacle;

步骤ⅱ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b越过障碍物沿地面向下平台的内侧移动,连接处a向上抬起同时对应的移动副缩短,越过障碍物;Step 2. Control the corresponding second rotation pair to rotate downward to the inner side of the platform through the steering gear M6 to set the angle, so that the connection b goes over the obstacle and moves down the inner side of the platform, and the connection a lifts up and moves correspondingly. Vice shortening, over obstacles;

步骤ⅲ、连接处a、b对应的移动副伸长至初始状态,按照权利要求9所述的行进模式行进,直至连接处c、d靠近障碍物;Step iii, the mobile pair corresponding to the connection points a and b are extended to the initial state, and travel according to the traveling mode described in claim 9 until the connection points c and d are close to the obstacle;

步骤ⅳ、通过舵机M8控制对应的第二转动副向下平台的内侧转动设定角度,使连接处d沿地面向下平台的内侧移动,同时对应的移动副缩短,越过障碍物;Step iv. Control the corresponding second rotation pair to turn the inner side of the platform downward by the set angle through the steering gear M8, so that the connection d moves down the inner side of the platform along the ground, and at the same time, the corresponding moving pair shortens and crosses the obstacle;

步骤ⅴ、通过舵机M7控制对应的第二转动副向下平台的内侧转动设定角度,使连接处c沿地面向下平台的内侧移动,同时对应的移动副缩短,越过障碍物;Step ⅴ, control the corresponding second rotation pair to rotate downward to the inner side of the platform by the set angle through the steering gear M7, so that the connection c moves down the inner side of the platform along the ground, and at the same time, the corresponding moving pair is shortened and goes over obstacles;

步骤ⅶ、连接处c、d对应的移动副伸长至初始状态,从而使移动并联机构的连接处a、b、c、d回复初始状态。In step ⅶ, the moving pairs corresponding to the connection positions c and d are extended to the initial state, so that the connection positions a, b, c, and d of the mobile parallel mechanism return to the initial state.

本发明有益的技术效果在于:The beneficial technical effects of the present invention are:

(1)采集对称的4-RRPR多模式移动并联机构为本体作为移动机构,利用4-RRPR移动并联机构的变形特点,实现了“全姿态”滚动、四足行走、越障等多种运动模式,避免了单一移动方式的局限性,适应性好,可应对多重特征任务环境如台阶、沟道、斜坡等具有典型特征的地形,应用前景广泛;(1) Collect the symmetrical 4-RRPR multi-mode mobile parallel mechanism as the main body as the mobile mechanism, and use the deformation characteristics of the 4-RRPR mobile parallel mechanism to realize the "full posture" rolling, four-legged walking, obstacle crossing and other motion modes. , avoids the limitation of a single movement mode, has good adaptability, can deal with terrains with typical characteristics such as steps, channels, slopes, etc. with multiple characteristics, and has a wide application prospect;

(2)本发明的4-RRPR多模式移动并联机构,通过控制电路板对各舵机进行分时控制与电机的控制,两者相互配合调节,可实现机构的变形与各运动模式之间的自动转换。(2) The 4-RRPR multi-mode mobile parallel mechanism of the present invention performs time-sharing control of each steering gear and motor control through the control circuit board, and the two cooperate with each other to adjust, which can realize the deformation of the mechanism and the relationship between each motion mode. Automatic conversion.

(3)本发明的4-RRPR多模式移动并联机构,改善了动力学性能,增加结构刚度,具有刚度、精度、承载力较好的特点,扩大了移动机构在救援、检测、勘探等环境的应用范围和通行能力。(3) The 4-RRPR multi-mode mobile parallel mechanism of the present invention improves the dynamic performance, increases the structural rigidity, has the characteristics of better rigidity, precision and bearing capacity, and expands the mobile mechanism in the rescue, detection, exploration and other environments. Application range and traffic capacity.

附图说明Description of drawings

图1为本发明的总体结构示意图一,该支链处于弯曲状态;Fig. 1 is the overall structure schematic diagram 1 of the present invention, and the branched chain is in a bent state;

图2为本发明的总体结构示意图二,该支链处于伸长状态;Fig. 2 is the general structure schematic diagram II of the present invention, and this branch chain is in the elongation state;

图3为本发明的滚动模式下的机构形态变化过程示意图;3 is a schematic diagram of the change process of the mechanism shape under the rolling mode of the present invention;

图4为本发明的行进模式的初始状态示意图;Fig. 4 is the initial state schematic diagram of the travel mode of the present invention;

图5为本发明的行进模式下的机构形态变化过程示意图;5 is a schematic diagram of the change process of the mechanism shape under the travel mode of the present invention;

图6为本发明的越障模式下的机构形态变化过程示意图;6 is a schematic diagram of the change process of the mechanism shape under the obstacle crossing mode of the present invention;

其中,1-上平台,2-下平台,3-支链,31-第一转动副,32-第二转动副,33-移动副,34-第三转动副,35-连杆,4-舵机。Among them, 1-upper platform, 2-lower platform, 3-branch chain, 31-first rotating pair, 32-second rotating pair, 33-moving pair, 34-third rotating pair, 35-connecting rod, 4- steering gear.

具体实施方式Detailed ways

下面结合附图及较佳实施例详细说明本发明的具体实施方式。The specific embodiments of the present invention will be described in detail below with reference to the accompanying drawings and preferred embodiments.

如图1和2所示,本发明提供了一种多运动模式的移动并联机构,包括平行四边形结构的上平台1和下平台2,该上平台1与下平台2平行设置,两者之间设置有多条支链3,多条支链3彼此平行设置,包括三个转动副和一个移动副,其首尾端通过舵机4与上平台1和下平台2相连,所有转动副的转动轴的轴向中心线均相互平行,且与上平台1或者下平台2的同一边平行。As shown in Figures 1 and 2, the present invention provides a moving parallel mechanism with multi-movement modes, including an upper platform 1 and a lower platform 2 of parallelogram structure, the upper platform 1 and the lower platform 2 are arranged in parallel, and there is a gap between the two. A plurality of branch chains 3 are provided, and the plurality of branch chains 3 are arranged in parallel with each other, including three rotating pairs and one moving pair, the head and tail ends of which are connected with the upper platform 1 and the lower platform 2 through the steering gear 4, and the rotating shafts of all the rotating pairs are connected. The axial centerlines are parallel to each other and parallel to the same side of the upper platform 1 or the lower platform 2 .

该舵机4设置有多个,分布设置在上平台1和下平台2相对的一面的四个角上,上平台1的舵机4与支链3首端的第一转动副31相连,下平台2的舵机4与支链3尾端的第二转动32副相连,第一转动副31通过移动副33与第三转动副34相连,第三转动副34通过连杆35与第二转动副32相连。该移动副33可设置为电动伸缩杆。There are multiple steering gears 4, which are distributed on the four corners of the opposite side of the upper platform 1 and the lower platform 2. The steering gear 4 of the upper platform 1 is connected to the first rotating pair 31 at the head end of the branch chain 3, and the lower platform The steering gear 4 of 2 is connected with the second rotating pair 32 at the end of the branch chain 3, the first rotating pair 31 is connected with the third rotating pair 34 through the moving pair 33, and the third rotating pair 34 is connected with the second rotating pair 32 through the connecting rod 35. connected. The moving pair 33 can be configured as an electric telescopic rod.

本发明提供了一种基于上文所述的多运动模式的移动并联机构的控制方法,利用设置在上平台1和下平台2上的多个舵机4之间的分时协同作业控制多条支链3的运动,如弯曲、伸直、转动等等,实现移动并联机构的滚动、行走和越障模式及其模式之间的切换。The present invention provides a control method of the mobile parallel mechanism based on the above-mentioned multi-motion mode, which utilizes the time-sharing cooperative operation between the plurality of steering gears 4 arranged on the upper platform 1 and the lower platform 2 to control a plurality of The movement of the branch chain 3, such as bending, straightening, rotating, etc., realizes the switching between the rolling, walking and obstacle-crossing modes of the mobile parallel mechanism and the switching between the modes.

当遇到平坦路面或沟渠路面时,整个机构可选择“全姿态”滚动模式。可通过驱动舵机4同步带动连杆35转动一定角度,由于机构重心偏移,使得机构翻倒,再通过驱动舵机4令机构具有一定的加速度,从而产生惯性力,使机构下平台抬起,上平台接地,从而实现机构整体向前滚动。即可通过多个舵机4控制对应的第一转动副31、第二转动副32的转动,带动对应的第三转动副34的转动,从而控制对应支链3不断地弯曲和拉直,实现上平台1和下平台2的交替着地,进而实现整个移动并联机构的滚动,如图3所示,具体如下:When encountering flat or ditch roads, the entire mechanism can select a "full-stance" rolling mode. The connecting rod 35 can be driven to rotate at a certain angle by driving the steering gear 4 synchronously. Due to the offset of the center of gravity of the mechanism, the mechanism is overturned, and then the steering gear 4 is driven to make the mechanism have a certain acceleration, thereby generating an inertial force to lift the lower platform of the mechanism. , the upper platform is grounded, so that the whole mechanism rolls forward. The rotation of the corresponding first rotation pair 31 and the second rotation pair 32 can be controlled by the plurality of steering gears 4 to drive the rotation of the corresponding third rotation pair 34, so as to control the corresponding branch chain 3 to continuously bend and straighten, so as to realize The alternate landing of the upper platform 1 and the lower platform 2, thereby realizing the rolling of the entire mobile parallel mechanism, as shown in Figure 3, as follows:

将上平台1的四个舵机4依次顺时标记为M1、M2、M3和M4,对应舵机M1、M2、M3和M4,该下平台2的四个舵4机依次标记为M5、M6、M7和M8,滚动模式的初始状态设置为锁定四个移动副33,下平台1着地,与之相连的四个支链3垂直于上平台1和下平台2站立,如图3(1)所示,Mark the four steering gears 4 of the upper platform 1 as M1, M2, M3 and M4 in turn, corresponding to the steering gears M1, M2, M3 and M4, and mark the four steering gears of the lower platform 2 as M5, M6 in turn , M7 and M8, the initial state of the rolling mode is set to lock the four moving pairs 33, the lower platform 1 is on the ground, and the four branch chains 3 connected to it stand perpendicular to the upper platform 1 and the lower platform 2, as shown in Figure 3 (1) shown,

步骤一、通过舵机M5、M6、M7和M8控制对应的第二转动副向滚动方向同时转动,可以根据整个机构的尺寸,设置转动角度如45度,带动对应的第三转动副同时转动,使对应的连杆与移动副之间产生夹角,如图3(2)所示,直至整个移动并联机构的重心超过下平台的边界,借助转动过程中的加速度产生惯性力,整个移动并联机构翻到,其上靠近地面的连杆着地,如图3(3)所示;Step 1. Control the corresponding second rotating pair to rotate simultaneously in the rolling direction through the steering gears M5, M6, M7 and M8. According to the size of the entire mechanism, set the rotation angle such as 45 degrees to drive the corresponding third rotating pair to rotate at the same time. Make an angle between the corresponding connecting rod and the moving pair, as shown in Figure 3(2), until the center of gravity of the entire moving parallel mechanism exceeds the boundary of the lower platform, and the inertial force is generated by the acceleration during the rotation process, and the entire moving parallel mechanism Turn it over, and the connecting rod near the ground touches the ground, as shown in Figure 3(3);

步骤二、通过舵机M1、M2、M3和M4控制对应的第一转动副向滚动方向同时转动,带动对应的第三转动副同时转动,直至对应的连杆与移动副处于同一直线上,如图3(4)所示;Step 2: Control the corresponding first rotating pair to rotate simultaneously in the rolling direction through the steering gears M1, M2, M3 and M4, and drive the corresponding third rotating pair to rotate at the same time until the corresponding connecting rod and the moving pair are on the same straight line, such as As shown in Figure 3(4);

步骤三、通过舵机M1、M2与舵机M5、M6或舵机M3、M4与舵机M7、M8控制对应的第一转动副、第二转动副向滚动方向同时转动,带动舵机M3、M4与舵机M7、M8或者舵机M1、M2与舵机M5、M6对应第一转动副、第二转动副向滚动方向同时转动,直至上平台与地面的夹角小于30度,整个移动并联机构的重心超过上平台的中心,从而使上平台着地,与之相连的四个支链垂直于上平台和下平台站立,如图3(5)所示;Step 3. The first and second rotation pairs controlled by the steering gears M1 and M2 and the steering gears M5 and M6 or the steering gears M3 and M4 and the steering gears M7 and M8 are simultaneously rotated in the rolling direction, so as to drive the steering gears M3 and M8. M4 and steering gears M7, M8 or steering gears M1, M2 and steering gears M5, M6 rotate simultaneously in the rolling direction corresponding to the first rotation pair and the second rotation pair, until the angle between the upper platform and the ground is less than 30 degrees, and the entire movement is parallel. The center of gravity of the mechanism exceeds the center of the upper platform, so that the upper platform is on the ground, and the four branch chains connected to it stand perpendicular to the upper platform and the lower platform, as shown in Figure 3(5);

步骤四、重复步骤一至三,使下平台着地,与之相连的四个支链垂直于上平台和下平台站立;Step 4. Repeat steps 1 to 3 to make the lower platform touch the ground, and the four branches connected to it stand perpendicular to the upper platform and the lower platform;

步骤五、重复步骤一至四,使上平台、下平台交替着地,完成移动并联机构的滚动模式。Step 5: Repeat steps 1 to 4 to make the upper platform and the lower platform land alternately to complete the rolling mode of the mobile parallel mechanism.

当机构处于平坦地面时,机构选择行走模式,可通过控制舵机同步带动连杆向下转动一定角度,形成四足支撑于地面的状态;再分别驱动相应的舵机,带动相应的连杆交替抬起与落地,从而完成机构在平坦路面的四足行走模式。即通过设置在下平台上的多个舵机控制对应的第二转动副同时转动,带动对应的第三转动副、第一转动副的转动,使对应的连杆与移动副连接处着地,形成四足结构,再通过下平台上的多个舵机控制对应的第三转动副逐个抬起、落地,实现整个移动并联机构的行走,如图4和5所示,具体如下:When the mechanism is on a flat ground, the mechanism selects the walking mode, and the steering gear can be controlled to synchronously drive the connecting rod to rotate downward by a certain angle, so as to form a state where the four legs are supported on the ground; and then drive the corresponding steering gear respectively to drive the corresponding connecting rods alternately. Raise and land to complete the quadruped walking mode of the mechanism on a flat surface. That is, the corresponding second rotating pair is controlled to rotate at the same time by a plurality of steering gears arranged on the lower platform, which drives the rotation of the corresponding third rotating pair and the first rotating pair, so that the connection between the corresponding connecting rod and the moving pair touches the ground, forming four The foot structure is then controlled by the multiple steering gears on the lower platform to control the corresponding third rotating pair to lift and land one by one to realize the walking of the entire mobile parallel mechanism, as shown in Figures 4 and 5, as follows:

行走模式的初始状态设置为锁定四个移动副,由下平台1着地,与之相连的四个支链3垂直于上平台1和下平台2站立的状态,如图5A所示,通过舵机M5、M6、M7和M8控制对应的第二转动副同时向下转动120度,使下平台整体上抬,对应的连杆与移动副连接处着地站立,如图5B所示,该连接处依次标记为a、b、c、d,移动并联机构重心的初始位置处于机构的几何中心,如图4所示,The initial state of the walking mode is set to lock the four moving pairs, the lower platform 1 touches the ground, and the four branch chains 3 connected to it stand perpendicular to the upper platform 1 and the lower platform 2, as shown in Figure 5A, through the steering gear M5, M6, M7 and M8 control the corresponding second rotating pair to rotate 120 degrees downward at the same time, so that the lower platform is lifted up as a whole, and the corresponding connecting rod and the moving pair are standing on the ground, as shown in Figure 5B, the connection is in turn Marked as a, b, c, d, the initial position of the center of gravity of the mobile parallel mechanism is at the geometric center of the mechanism, as shown in Figure 4,

步骤Ⅰ、通过舵机M5控制对应的第二转动副向下平台的内侧转动设定角度,使连接处a沿地面向下平台的内侧移动,整个机构的重心被抬高并向后移动,靠连接点acd支撑,从而使连接处b朝行进方向抬起,如图5C所示,该设定角度可以根据整个机构的尺寸进行设计,如15度,而连接处可以抬起的高度h可由如下公式计算得到,Step 1. Control the corresponding second rotation pair to turn the inner side of the platform downward through the steering gear M5 to set the angle, so that the connection point a moves down the inner side of the platform along the ground, and the center of gravity of the whole mechanism is raised and moved backwards. The connection point acd supports, so that the connection point b is lifted towards the traveling direction, as shown in Figure 5C, the set angle can be designed according to the size of the whole mechanism, such as 15 degrees, and the height h that the connection point can be lifted can be determined as follows calculated by the formula,

h=lsin(α12)-asinα2 h=lsin(α 12 )-asinα 2

其中,l表示连杆的长度,α1表示舵机控制对应的第二转动副的转动角度,α2表示连杆与地面之间的夹角;Wherein, l represents the length of the connecting rod, α 1 represents the rotation angle of the second rotating pair corresponding to the steering gear control, and α 2 represents the angle between the connecting rod and the ground;

步骤Ⅱ、通过舵机M8控制对应的第二转动副向下平台的内侧转动设定角度,使连接处d沿地面向下平台的内侧移动,移动并联机构的重心沿行进方向超过初始位置,连接处b落地,整个机构向前移靠连接点abc支撑,连接处d抬起,如图5D所示;Step II: Control the corresponding second rotation pair to rotate downward to the inner side of the platform through the steering gear M8 to set the angle, so that the connection d moves down the inner side of the platform along the ground, and the center of gravity of the moving parallel mechanism exceeds the initial position along the traveling direction, and the connection Landing at point b, the whole mechanism moves forward and is supported by the connection point abc, and the connection point d lifts up, as shown in Figure 5D;

步骤Ⅲ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b沿地面向下平台的内侧移动,连接处d落地,整个机构的重心向后移动,靠连接点bcd支撑,连接处a朝行进方向抬起,如图5E所示;Step III: Control the corresponding second rotation pair to turn the inner side of the platform downward through the set angle through the steering gear M6, so that the connection b moves down the inner side of the platform along the ground, the connection d falls to the ground, and the center of gravity of the whole mechanism moves backward, Supported by the connection point bcd, the connection point a is lifted towards the traveling direction, as shown in Figure 5E;

步骤Ⅳ、通过舵机M7控制对应的第二转动副向下平台的内侧转动设定角度,使连接处c沿地面向下平台的内侧移动,移动并联机构的重心沿行进方向超过初始位置,连接处a落地,带动整个移动并联机构向行进方向移动,如图5F所示,此时的行进距离L可由如下公式计算得到,Step Ⅳ. Control the corresponding second rotation pair to turn the inner side of the platform downward through the steering gear M7 to set the angle, so that the connection point c moves down the inner side of the platform along the ground, and the center of gravity of the moving parallel mechanism exceeds the initial position along the traveling direction, and the connection is Landing at a, drives the entire mobile parallel mechanism to move in the direction of travel, as shown in Figure 5F, the travel distance L at this time can be calculated by the following formula:

L=lcos(α12)-acosα2 L=lcos(α 12 )-acosα 2

其中,l表示连杆的长度,α1表示舵机控制对应的第二转动副的转动角度,α2表示连杆与地面之间的夹角;Wherein, l represents the length of the connecting rod, α 1 represents the rotation angle of the second rotating pair corresponding to the steering gear control, and α 2 represents the angle between the connecting rod and the ground;

步骤Ⅴ、通过舵机M5、M6、M7和M8控制对应的第二转动副同时下平台的内侧转动相同的设定角度,使移动并联机构回复初始状态;Step Ⅴ: Control the corresponding second rotation pair through the steering gears M5, M6, M7 and M8 and simultaneously lower the inner side of the platform to rotate the same set angle, so that the mobile parallel mechanism returns to the initial state;

步骤Ⅵ、重复步骤Ⅰ至Ⅴ,使移动并联机构始终处于行走状态。Step VI, repeat steps I to V, so that the mobile parallel mechanism is always in the walking state.

当机构处于不平坦地面时,机构选择四足行走越障模式,可通过控制舵机同步带动连杆向下转动一定角度,形成四足支撑于地面的状态;再分别驱动相应的舵机,带动相应的连杆交替抬起,并控制相应的直线电机带动连杆越过障碍,从而完成机构在不平坦路面的四足行走越障模式。即通过设置在下平台上的多个舵机控制对应的第二转动副同时转动,带动对应的第三转动副、第一转动副的转动,使对应的连杆与移动副连接处着地,形成四足结构,再通过下平台上的多个舵机控制对应的第三转动副逐个抬起、落地以及对应移动副的伸长和缩短,实现整个移动并联机构的越障,具体如下:When the mechanism is on uneven ground, the mechanism selects the four-legged walking obstacle mode, and the steering gear can be controlled to synchronously drive the connecting rod to rotate downward at a certain angle, so as to form a state where the four feet are supported on the ground; and then drive the corresponding steering gear to drive the The corresponding connecting rods are lifted alternately, and the corresponding linear motors are controlled to drive the connecting rods to cross the obstacles, so as to complete the four-legged obstacle-crossing mode of the mechanism on uneven roads. That is, the corresponding second rotating pair is controlled to rotate at the same time by a plurality of steering gears arranged on the lower platform, which drives the rotation of the corresponding third rotating pair and the first rotating pair, so that the connection between the corresponding connecting rod and the moving pair touches the ground, forming four The foot structure is then controlled by the multiple steering gears on the lower platform to control the corresponding third rotating pair to lift and land one by one, as well as the extension and shortening of the corresponding moving pair, so as to realize the obstacle crossing of the entire mobile parallel mechanism. The details are as follows:

越障模式的初始状态设置为舵机M5、M6、M7和M8控制对应的第二转动副同时向下转动120度,使下平台整体上抬,对应的连杆与移动副连接处着地站立,所述连接处依次标记为a、b、c、d,连接处a、b靠近障碍物,如图6(A)所示,The initial state of the obstacle crossing mode is set as the second rotating pair corresponding to the steering gear M5, M6, M7 and M8 control and rotate 120 degrees downward at the same time, so that the lower platform is lifted as a whole, and the corresponding connecting rod and the moving pair are connected to the ground and stand. The joints are marked as a, b, c, and d in turn, and the joints a and b are close to the obstacle, as shown in Figure 6(A),

步骤ⅰ、通过舵机M5控制对应的第二转动副向下平台的内侧转动设定角度,使连接处a沿地面向下平台的内侧移动,连接处b向上抬起同时对应的移动副缩短,与障碍物的顶部接触,此时连接处b对应的连杆的端部已经超过障碍物的顶部边缘,如图6(B)所示;Step 1. Control the corresponding second rotation pair to rotate downward to the inner side of the platform through the steering gear M5 to set the angle, so that the connection point a moves down the inner side of the platform along the ground, and the connection point b is lifted up and the corresponding moving pair is shortened. Contact with the top of the obstacle, and the end of the connecting rod corresponding to the connection b has exceeded the top edge of the obstacle, as shown in Figure 6(B);

步骤ⅱ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b越过障碍物沿地面向下平台的内侧移动,连接处a向上抬起同时对应的移动副缩短,越过障碍物,如图6(C)所示;Step 2. Control the corresponding second rotation pair to rotate downward to the inner side of the platform through the steering gear M6 to set the angle, so that the connection b goes over the obstacle and moves down the inner side of the platform, and the connection a lifts up and moves correspondingly. The pair shortens and crosses the obstacle, as shown in Figure 6(C);

步骤ⅲ、连接处a、b对应的移动副伸长至初始状态,如图6(D),所示按照权利要求9所述的行进模式行进,直至连接处c、d靠近障碍物;Step iii, the mobile pair corresponding to the connection points a and b are extended to the initial state, as shown in Figure 6(D), as shown in the traveling mode according to claim 9, until the connection points c and d are close to the obstacle;

步骤ⅳ、通过舵机M8控制对应的第二转动副向下平台的内侧转动设定角度,使连接处d沿地面向下平台的内侧移动,同时对应的移动副缩短,越过障碍物,如图6(E)所示;Step iv. Control the corresponding second rotation pair to turn down the inner side of the platform through the steering gear M8 to set the angle, so that the connection d moves down the inner side of the platform along the ground, and at the same time, the corresponding moving pair is shortened and crosses the obstacle, as shown in the figure 6(E);

步骤ⅴ、通过舵机M7控制对应的第二转动副向下平台的内侧转动设定角度,使连接处c沿地面向下平台的内侧移动,同时对应的移动副缩短,越过障碍物,如图6(F)所示;Step ⅴ, control the corresponding second rotation pair to turn down the inner side of the platform through the steering gear M7 to set the angle, so that the connection c moves down the inner side of the platform along the ground, and at the same time, the corresponding moving pair is shortened and crosses the obstacle, as shown in the figure 6(F);

步骤ⅶ、连接处c、d对应的移动副伸长至初始状态,从而使移动并联机构的连接处a、b、c、d回复初始状态。In step ⅶ, the moving pairs corresponding to the connection points c and d are extended to the initial state, so that the connection points a, b, c, and d of the mobile parallel mechanism return to the initial state.

虽然以上描述了本发明的具体实施方式,但是本领域的技术人员应当理解,这些仅是举例说明,在不背离本发明的原理和实质的前提下,可以对这些实施方式做出多种变更或修改,因此,本发明的保护范围由所附权利要求书限定。Although the specific embodiments of the present invention have been described above, those skilled in the art should understand that these are only examples, and various changes may be made to these embodiments without departing from the principle and essence of the present invention. Modifications, therefore, the scope of protection of the present invention is defined by the appended claims.

Claims (7)

1. A moving parallel mechanism with multiple motion modes is characterized in that: the device comprises an upper platform and a lower platform which are of parallelogram structures, wherein the upper platform and the lower platform are arranged in parallel, a plurality of branched chains are arranged between the upper platform and the lower platform, the branched chains are arranged in parallel, the branched chains comprise three revolute pairs and a revolute pair, the head end and the tail end of the revolute pair are connected with the upper platform and the lower platform through steering engines, and the axial center lines of the rotating shafts of all the revolute pairs are parallel to each other and are parallel to the same side of the upper platform or the lower platform;
the steering gears are distributed on four corners of one surface of the upper platform opposite to the lower platform, the steering gears of the upper platform are connected with a first rotating pair at the head end of the branched chain, the steering gears of the lower platform are connected with a second rotating pair at the tail end of the branched chain, the first rotating pair is connected with a third rotating pair through a moving pair, and the third rotating pair is connected with the second rotating pair through a connecting rod;
the movement of a plurality of branched chains is controlled by utilizing the cooperative operation between a plurality of steering engines arranged on the upper platform and the lower platform, so that the rolling, walking and obstacle crossing modes of the movable parallel mechanism and the switching between the modes are realized;
the steering engines arranged on the lower platform control the corresponding second revolute pairs to rotate simultaneously to drive the corresponding third revolute pairs and first revolute pairs to rotate, so that the joints of the corresponding connecting rods and the revolute pairs land to form a four-footed structure, and the steering engines on the lower platform control the corresponding third revolute pairs to lift up and land one by one to realize a walking mode of the movable parallel mechanism; and controlling the corresponding third revolute pairs to lift up and fall to the ground one by one and to extend and shorten corresponding revolute pairs through a plurality of steering engines on the lower platform, so as to realize an obstacle crossing mode of the movable parallel mechanism.
2. The multiple motion mode mobile parallel mechanism of claim 1, wherein: the sliding pair is an electric telescopic rod.
3. The multiple motion mode mobile parallel mechanism of claim 1, wherein: the steering engines are used for controlling the corresponding first rotating pair and the corresponding second rotating pair to rotate so as to drive the corresponding third rotating pair to rotate, so that the corresponding branched chains are controlled to be continuously bent and straightened, the upper platform and the lower platform are alternatively landed, and the rolling mode of the movable parallel mechanism is further realized.
4. A multiple movement pattern moving parallel mechanism according to claim 3, wherein the control method of the rolling pattern includes the steps of:
the four steering engines of the upper platform are sequentially marked as M1, M2, M3 and M4 in sequence, the four steering engines of the lower platform are sequentially marked as M1, M2, M3 and M4, the four steering engines of the lower platform are sequentially marked as M5, M6, M7 and M8, the initial state of the rolling mode is set to be four sliding pairs, the lower platform lands on the ground, four branched chains connected with the lower platform stand perpendicular to the upper platform and the lower platform,
step one, controlling the corresponding second rotating pairs to simultaneously rotate in the rolling direction through the steering engines M5, M6, M7 and M8, driving the corresponding third rotating pairs to simultaneously rotate, and enabling the corresponding connecting rods and the moving pairs to form included angles until the gravity center of the whole moving parallel mechanism exceeds the boundary of the lower platform;
step two, controlling the corresponding first rotating pairs to simultaneously rotate in the rolling direction through the steering engines M1, M2, M3 and M4, and driving the corresponding third rotating pairs to simultaneously rotate until the corresponding connecting rods and the corresponding sliding pairs are positioned on the same straight line;
step three, controlling corresponding first rotating pairs and second rotating pairs to simultaneously rotate in the rolling direction through steering engines M1, M2 and steering engines M5, M6 or steering engines M3, M4 and steering engines M7, M8, driving the steering engines M3, M4 and the steering engines M7, M8 or the steering engines M1, M2 and the steering engines M5, M6 to simultaneously rotate in the rolling direction corresponding to the first rotating pairs and the second rotating pairs until the gravity center of the whole moving parallel mechanism exceeds the center of the upper platform, so that the upper platform lands, and four branched chains connected with the upper platform stand perpendicular to the upper platform and the lower platform;
step four, repeating the steps one to three, so that the lower platform lands on the ground, and four branched chains connected with the lower platform stand vertically to the upper platform and the lower platform;
and step five, repeating the steps one to four to enable the upper platform and the lower platform to touch the ground alternately to complete the rolling mode of the movable parallel mechanism.
5. The multiple motion mode mobile parallel mechanism of claim 4, wherein: in the first step, the steering engines M5, M6, M7 and M8 are used for controlling the rotation angle of the corresponding second revolute pair to be set to 45 degrees; the corresponding first rotating pair and the corresponding second rotating pair are controlled to rotate simultaneously in the rolling direction through the steering engines M1 and M2 and the steering engines M5 and M6 or the steering engines M3 and M4 and the steering engines M7 and M8 until the included angle between the upper platform and the ground is less than 30 degrees.
6. The multiple movement pattern mobile parallel mechanism according to claim 1, wherein the control method of the walking pattern comprises the steps of:
sequentially marking four steering engines of the upper platform as M1, M2, M3 and M4 in a clockwise manner, corresponding to the steering engines M1, M2, M3 and M4, sequentially marking the four steering engines of the lower platform as M5, M6, M7 and M8, setting the initial state of a walking mode to be four moving pairs in a locked manner, controlling the corresponding second rotating pairs to rotate downwards by 120 degrees by the steering engines M5, M6, M7 and M8, so that the lower platform is integrally lifted, the joints of the corresponding connecting rods and the moving pairs are grounded and stand, sequentially marking the joints as a, b, c and d, and the initial position of the gravity center of the moving parallel mechanism is positioned at the geometric center of the mechanism,
step I, controlling a corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M5, enabling a joint a to move towards the inner side of the lower platform along the ground, and enabling a joint b to lift towards the advancing direction;
step II, controlling a corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M8, enabling a joint d to move towards the inner side of the lower platform along the ground, moving the gravity center of the parallel mechanism to exceed the initial position along the advancing direction, enabling a joint b to fall to the ground, and lifting the joint d;
step III, controlling a corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M6, enabling a joint b to move towards the inner side of the lower platform along the ground, enabling a joint d to land, and lifting the joint a towards the traveling direction;
step IV, controlling a corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M7, enabling a joint c to move towards the inner side of the lower platform along the ground, moving the gravity center of the parallel mechanism to exceed the initial position along the advancing direction, and enabling a joint a to land to drive the whole movable parallel mechanism to move towards the advancing direction;
step V, controlling corresponding second revolute pairs through steering engines M5, M6, M7 and M8, and enabling the inner sides of the lower platforms to rotate by the same set angle at the same time, so that the movable parallel mechanism returns to the initial state;
and VI, repeating the steps I to V to enable the movable parallel mechanism to be in a walking state all the time.
7. The multiple-motion-mode mobile parallel mechanism according to claim 6, wherein the control method of the obstacle crossing mode comprises the steps of:
the four steering engines of the upper platform are sequentially marked as M1, M2, M3 and M4 in a clockwise manner, the four steering engines of the lower platform are correspondingly marked as M1, M2, M3 and M4 in a clockwise manner, the four steering engines of the lower platform are sequentially marked as M5, M6, M7 and M8 in a clockwise manner, the initial state of the obstacle crossing mode is set as that the steering engines M5, M6, M7 and M8 control the corresponding second revolute pair to rotate downwards by 120 degrees at the same time, so that the lower platform is integrally lifted, the corresponding connecting rod and the moving pair are connected with the ground and stand, the connecting positions are sequentially marked as a, b, c and d, and the connecting positions a and b are close to an obstacle,
step i, controlling a corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M5, enabling a joint a to move towards the inner side of the lower platform along the ground, and lifting a joint b upwards while shortening a corresponding revolute pair to contact the top of the barrier;
step ii, the steering engine M6 is used for controlling the corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle, so that the joint b crosses the obstacle and moves towards the inner side of the lower platform along the ground, the joint a is lifted upwards, and meanwhile, the corresponding revolute pair is shortened to cross the obstacle;
step iii, extending the sliding pair corresponding to the joints a and b to an initial state, and advancing according to the advancing mode of claim 6 until the joints c and d are close to the obstacle;
step iv, controlling the corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M8, so that the joint d moves towards the inner side of the lower platform along the ground, and meanwhile, the corresponding revolute pair is shortened to cross an obstacle;
step v, controlling the corresponding second revolute pair to rotate towards the inner side of the lower platform by a set angle through a steering engine M7, so that the joint c moves towards the inner side of the lower platform along the ground, and meanwhile, the corresponding revolute pair is shortened to cross an obstacle;
and step vii, extending the sliding pair corresponding to the joints c and d to the initial state, so as to restore the joints a, b, c and d of the movable parallel mechanism to the initial state.
CN201910352735.3A 2019-04-29 2019-04-29 Mobile parallel mechanism with multiple motion modes and control method thereof Active CN110076754B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910352735.3A CN110076754B (en) 2019-04-29 2019-04-29 Mobile parallel mechanism with multiple motion modes and control method thereof

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910352735.3A CN110076754B (en) 2019-04-29 2019-04-29 Mobile parallel mechanism with multiple motion modes and control method thereof

Publications (2)

Publication Number Publication Date
CN110076754A CN110076754A (en) 2019-08-02
CN110076754B true CN110076754B (en) 2022-08-09

Family

ID=67417410

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910352735.3A Active CN110076754B (en) 2019-04-29 2019-04-29 Mobile parallel mechanism with multiple motion modes and control method thereof

Country Status (1)

Country Link
CN (1) CN110076754B (en)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110465957A (en) * 2019-09-09 2019-11-19 安徽建筑大学 A kind of rolling mobile robot
CN111089148B (en) * 2020-01-15 2021-01-19 北京交通大学 Multi-mode infinite turnover mechanism
CN113064421B (en) * 2021-03-08 2023-03-31 上海工程技术大学 Portable multi-mode mobile robot
CN113043246A (en) * 2021-03-08 2021-06-29 上海工程技术大学 Reconfigurable multi-mode parallel mobile robot
CN113334365B (en) * 2021-05-12 2022-08-05 上海工程技术大学 Folding and unfolding reconfigurable multi-mode mobile robot
CN114083553B (en) * 2022-01-06 2023-05-26 上海工程技术大学 Polymorphic mobile robot
CN114714378B (en) * 2022-05-16 2023-05-26 上海工程技术大学 A parallel reconfigurable mountain forest mobile robot

Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1483554A (en) * 2003-08-15 2004-03-24 清华大学 An adjustable quadruped bionic robot motion structure
KR101709606B1 (en) * 2015-08-31 2017-02-28 (주)경서글로텍 Cleaning apparatus and cleaning method for using the same
CN207972688U (en) * 2017-11-07 2018-10-16 山东交通学院 A kind of modularization robot shipping platform of electric cylinder driving

Family Cites Families (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH05131382A (en) * 1991-11-11 1993-05-28 Takeshi Yanagisawa Walking robot
CN101774408A (en) * 2009-01-14 2010-07-14 林砺宗 Four-leg bionic walking mechanism
CN201660033U (en) * 2010-02-12 2010-12-01 李剑川 Obstacle detouring walk system of one caterpillar and one bending leg of compound wheel
CN102351018B (en) * 2011-08-11 2013-02-06 西北工业大学 A quadruped robot leg joint
US20140150593A1 (en) * 2012-12-05 2014-06-05 Alio Industries, Inc. Precision tripod motion system
CN105818133B (en) * 2016-04-20 2017-09-26 燕山大学 One kind one rotates single-freedom-degree parallel mechanism
CN108639181B (en) * 2018-06-07 2023-04-21 长安大学 A multi-degree-of-freedom quadruped bionic robot
CN109050697B (en) * 2018-07-25 2020-05-05 上海工程技术大学 Multi-mode full-attitude moving parallel mechanism

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN1483554A (en) * 2003-08-15 2004-03-24 清华大学 An adjustable quadruped bionic robot motion structure
KR101709606B1 (en) * 2015-08-31 2017-02-28 (주)경서글로텍 Cleaning apparatus and cleaning method for using the same
CN207972688U (en) * 2017-11-07 2018-10-16 山东交通学院 A kind of modularization robot shipping platform of electric cylinder driving

Also Published As

Publication number Publication date
CN110076754A (en) 2019-08-02

Similar Documents

Publication Publication Date Title
CN110076754B (en) Mobile parallel mechanism with multiple motion modes and control method thereof
US11312436B2 (en) Obstacle crossing robot
CN106737578B (en) A kind of quadruped robot
CN107414793B (en) Construction method of hybrid walking robot and hybrid walking robot thereof
KR100977348B1 (en) Motion control device and motion control method for legged mobile robot and robot device
KR100695355B1 (en) Walking control method of walking robot and walking robot
Koshiyama et al. Design and control of an all-direction steering type mobile robot
CN110667729B (en) Multi-foot walking robot
CN105035199B (en) It is a kind of can sufficient formula motion ball shape robot and its method of work
CN106809294B (en) The walking robot of cam link combined mechanism driving
CN108705514B (en) The sufficient walking mechanism of multi-mode two
CN101157372A (en) A walking wheel-track compound mobile robot
CN112847371B (en) Motion planning method for humanoid robot to dynamically cross continuous obstacles
CN105539036A (en) Amphibious robot capable of moving on flat ground with wheels and surmounting obstacles with legs and working method of amphibious robot
CN106863278B (en) Wheel-leg type 3-PUU parallel mobile robot
CN113894822A (en) An octapod robot with bionic rigid-flexible coupled legs and its control method
CN114802518B (en) Bionic deformable hexapod robot
CN108820067B (en) A multi-mode step-roll moving mechanism and its working method
CN206749956U (en) A kind of belt wheel leg mechanism of robot
Pack et al. A simplified forward gait control for a quadruped walking robot
CN205220850U (en) Multi -functional robot that hinders more
CN110304169A (en) A kind of dual-gripper leg group travelling platform and its control method
CN114619818B (en) Movement and gliding integrated simulated flying mouse robot with variable gesture
CN115675670A (en) Umbrella type wheel-track combined type structure moving platform for reconnaissance rescue task
Zhang et al. A novel locomotion controller based on coordination between leg and spine for a quadruped salamander-like robot

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