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 PDFInfo
- 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
Links
- 230000007246 mechanism Effects 0.000 title claims abstract description 92
- 238000000034 method Methods 0.000 title claims abstract description 19
- 238000005096 rolling process Methods 0.000 claims abstract description 33
- 230000005484 gravity Effects 0.000 claims description 18
- 238000004904 shortening Methods 0.000 claims description 3
- 230000004888 barrier function Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 6
- 230000001133 acceleration Effects 0.000 description 2
- 238000005452 bending Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005474 detonation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
- B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
- B25J9/00—Programme-controlled manipulators
- B25J9/003—Programme-controlled manipulators having parallel kinematics
- B25J9/0045—Programme-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
本发明属于运动控制的技术领域,公开了一种多运动模式的移动并联机构,包括平行四边形结构的上平台和下平台,所述上平台与下平台平行设置,两者之间设置有多条支链,多条所述支链彼此平行设置,包括三个转动副和一个移动副,其首尾端通过舵机与上平台和下平台相连,所有所述转动副的转动轴的轴向中心线均相互平行,且与上平台或者下平台的同一边平行。还公开了一种多运动模式的移动并联机构的控制方法,通过多个所述舵机控制对应的第一转动副、第二转动副的转动,带动对应的第三转动副的转动,从而控制对应支链不断地弯曲和拉直,实现上平台和下平台的交替着地,进而实现移动并联机构的滚动模式。
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.
Description
技术领域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控制对应的第二转动副向滚动方向同时转动,带动对应的第三转动副同时转动,使对应的连杆与移动副之间产生夹角,直至整个移动并联机构的重心超过下平台的边界;
步骤二、通过舵机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 5: Repeat
进一步,所述步骤一中通过舵机M5、M6、M7和M8控制对应的第二转动副的转动角度设置为45度;通过舵机M1、M2与舵机M5、M6或舵机M3、M4与舵机M7、M8控制对应的第一转动副、第二转动副向滚动方向同时转动,直至上平台与地面的夹角小于30度。Further, in the
进一步,通过设置在所述下平台上的多个舵机控制对应的第二转动副同时转动,带动对应的第三转动副、第一转动副的转动,使对应的连杆与移动副连接处着地,形成四足结构,再通过所述下平台上的多个舵机控制对应的第三转动副逐个抬起、落地,实现移动并联机构的行走模式;再通过所述下平台上的多个舵机控制对应的第三转动副逐个抬起、落地以及对应移动副的伸长和缩短,实现移动并联机构的越障模式。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朝行进方向抬起;
步骤Ⅱ、通过舵机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向上抬起同时对应的移动副缩短,与障碍物的顶部接触;
步骤ⅱ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b越过障碍物沿地面向下平台的内侧移动,连接处a向上抬起同时对应的移动副缩短,越过障碍物;
步骤ⅲ、连接处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
该舵机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
本发明提供了一种基于上文所述的多运动模式的移动并联机构的控制方法,利用设置在上平台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
当遇到平坦路面或沟渠路面时,整个机构可选择“全姿态”滚动模式。可通过驱动舵机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
将上平台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
步骤一、通过舵机M5、M6、M7和M8控制对应的第二转动副向滚动方向同时转动,可以根据整个机构的尺寸,设置转动角度如45度,带动对应的第三转动副同时转动,使对应的连杆与移动副之间产生夹角,如图3(2)所示,直至整个移动并联机构的重心超过下平台的边界,借助转动过程中的加速度产生惯性力,整个移动并联机构翻到,其上靠近地面的连杆着地,如图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 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
步骤Ⅰ、通过舵机M5控制对应的第二转动副向下平台的内侧转动设定角度,使连接处a沿地面向下平台的内侧移动,整个机构的重心被抬高并向后移动,靠连接点acd支撑,从而使连接处b朝行进方向抬起,如图5C所示,该设定角度可以根据整个机构的尺寸进行设计,如15度,而连接处可以抬起的高度h可由如下公式计算得到,
h=lsin(α1+α2)-asinα2 h=lsin(α 1 +α 2 )-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(α1+α2)-acosα2 L=lcos(α 1 +α 2 )-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)所示;
步骤ⅱ、通过舵机M6控制对应的第二转动副向下平台的内侧转动设定角度,使连接处b越过障碍物沿地面向下平台的内侧移动,连接处a向上抬起同时对应的移动副缩短,越过障碍物,如图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)
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)
| 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)
| 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)
| 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 |
-
2019
- 2019-04-29 CN CN201910352735.3A patent/CN110076754B/en active Active
Patent Citations (3)
| 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 |