CN113788082B - Reconfigurable spherical robot, control system and control method thereof - Google Patents
Reconfigurable spherical robot, control system and control method thereof Download PDFInfo
- Publication number
- CN113788082B CN113788082B CN202111090499.6A CN202111090499A CN113788082B CN 113788082 B CN113788082 B CN 113788082B CN 202111090499 A CN202111090499 A CN 202111090499A CN 113788082 B CN113788082 B CN 113788082B
- Authority
- CN
- China
- Prior art keywords
- robot
- spherical
- annular
- pendulum
- reconfigurable
- 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
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B62—LAND VEHICLES FOR TRAVELLING OTHERWISE THAN ON RAILS
- B62D—MOTOR VEHICLES; TRAILERS
- B62D57/00—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track
- B62D57/02—Vehicles characterised by having other propulsion or other ground- engaging means than wheels or endless track, alone or in addition to wheels or endless track with ground-engaging propulsion means, e.g. walking members
Landscapes
- Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Transportation (AREA)
- Mechanical Engineering (AREA)
- Toys (AREA)
- Manipulator (AREA)
Abstract
Description
技术领域technical field
本发明属于人工智能技术领域,尤其涉及一种可重构球形机器人、控制系统及其控制方法。The invention belongs to the technical field of artificial intelligence, and in particular relates to a reconfigurable spherical robot, a control system and a control method thereof.
背景技术Background technique
移动机器人作为帮助人类拓展认知范围的一类重要辅助工具,在人们的生产、生活中占有越来越重要的地位。人们不断对移动机器人进行改进,发展出了传统可变形式,复合式,以及其他新型移动机器人,用来提高机器人的移动能力。其中一类为球形移动机器人,其外型是一个球体,主要由球壳和内部驱动装置两个部分组成,外部的球壳不仅可以自由滚动,还可以起到保护内部驱动装置的作用,内部驱动装置在球壳内部运动来帮助球形机器人实现不同的运动形式。球体造型作为天然的滚动体具有良好的运动性能,能够实现灵活的全向运动。由于球体是完美的对称结构,也不会出现翻倒等无法运动的情况,能够适应复杂的运动环境和狭小的空间。相比其他传统移动机器人,球形机器人具有运动阻力小、调整能力强、适应性强和运动灵活的优点,在生活、军事、工业以及娱乐等领域都有很好的应用前景。As an important auxiliary tool to help humans expand their cognitive range, mobile robots are playing an increasingly important role in people's production and life. People continue to improve mobile robots, and develop traditional variable forms, compound types, and other new mobile robots to improve the mobility of robots. One of them is a spherical mobile robot, which is shaped like a sphere and is mainly composed of two parts: a spherical shell and an internal driving device. The external spherical shell can not only roll freely, but also protect the internal driving device. The device moves inside the spherical shell to help the spherical robot achieve different forms of motion. As a natural rolling body, the spherical shape has good motion performance and can realize flexible omnidirectional motion. Since the sphere is a perfect symmetrical structure, there will be no inability to move, such as overturning, and it can adapt to complex sports environments and narrow spaces. Compared with other traditional mobile robots, spherical robots have the advantages of small movement resistance, strong adjustment ability, strong adaptability and flexible movement, and have good application prospects in the fields of life, military, industry and entertainment.
目前:已有的球形机器人主要通过三种方式来实现运动:(1)采用偏心力矩驱动,主要利用的原理是:当球体或类球体的质心偏离球心时,翻转的球体具有很强的自稳定性来恢复平衡,以此来驱动球体运动。这种球形移动机器人的控制方式采用较为简单的开环控制,间接地控制电动机的输出力矩来控制球壳的运动,无法保证运动的精度。另外,这种机器人仅适合平整路面运行,不能爬坡和越障。(2)采用角动量守恒原理驱动,其工作原理是球体内部转子高速旋转,通过旋转惯性矩来驱动球形机器人全方位运动。这种球形机器人在其运动的初始阶段,需要人为辅助其保持直立姿态。另外,由于滚珠与球壳之间的摩擦以及维持陀螺仪高速旋转消耗电量严重,其运动效率较低,内部系统也难以搭载其他设备完成球形机器人需要执行的任务。同样,这种机器人也仅适合平整路面运行,不能爬坡和越障。(3)通过自身的变形产生运动。其原理是借助机器人自身的反复变形实现能量转化,从而驱动球形机器人运动。这种球形机器人具有一定的爬坡越障能力,但是需要弹性球壳和柔性执行机构。由于这种机器人需要反复变形,没有空间携带其他组件和驱动系统,需要拖缆运行,运动环境受到限制。At present: the existing spherical robot mainly realizes the movement through three ways: (1) using the eccentric torque drive, the principle mainly used is: when the center of mass of the sphere or spheroid deviates from the center of the sphere, the turned sphere has a strong self-motion Stability is used to restore balance, which drives the ball's motion. The control method of this spherical mobile robot adopts relatively simple open-loop control, which indirectly controls the output torque of the motor to control the movement of the spherical shell, which cannot guarantee the accuracy of the movement. In addition, this robot is only suitable for running on flat roads, and cannot climb slopes or overcome obstacles. (2) It is driven by the principle of conservation of angular momentum. Its working principle is that the rotor inside the sphere rotates at high speed, and the spherical robot is driven to move in all directions through the rotational moment of inertia. This spherical robot needs human assistance to maintain an upright posture in the initial stage of its movement. In addition, due to the high power consumption of the friction between the ball and the spherical shell and the high-speed rotation of the gyroscope, its movement efficiency is low, and it is difficult for the internal system to carry other equipment to complete the tasks that the spherical robot needs to perform. Similarly, this kind of robot is only suitable for running on smooth roads, and cannot climb slopes and overcome obstacles. (3) Generate motion through its own deformation. The principle is to use the repeated deformation of the robot itself to achieve energy conversion, thereby driving the movement of the spherical robot. This kind of spherical robot has a certain ability of climbing and surmounting obstacles, but it needs an elastic spherical shell and a flexible actuator. Since this kind of robot needs to be deformed repeatedly, there is no space to carry other components and drive systems, and it needs tow cable operation, and the motion environment is limited.
通过上述分析,现有技术存在的问题及缺陷为:Through the above analysis, the problems and defects in the prior art are:
(1)尽管球形机器人在平整路面上具有良好的运动性能,能够实现灵活的全向运动,但因其球形外壳的限制,很难在凹凸不平的路面行驶,几乎无法实现爬坡和越障。(1) Although the spherical robot has good motion performance on a flat road and can achieve flexible omnidirectional movement, it is difficult to drive on uneven roads due to the limitation of the spherical shell, and it is almost impossible to climb and overcome obstacles.
(2)尽管传统的可变形球形机器人具有一定的爬坡和越障能力,但属于被动越障,即无法对障碍物进行识别,也无法判定是否越过障碍物。(2) Although the traditional deformable spherical robot has a certain ability of climbing and surmounting obstacles, it is a passive obstacle surmounting, that is, it cannot recognize obstacles, and cannot determine whether to cross them.
(3)球形机器人是一个非线性、欠驱动、强耦合的典型非完整系统,加之外界不确定因素的影响,这在很大程度上局限了基于精确模型的反馈控制律的应用,因此球形机器人抗外扰能力差,在运动过程中容易受到外部扰动且容易发生侧滑。(3) The spherical robot is a typical non-holonomic system with nonlinearity, underactuation and strong coupling, coupled with the influence of external uncertain factors, which largely limits the application of the feedback control law based on the accurate model, so the spherical robot The ability to resist external disturbance is poor, and it is easy to be disturbed by external disturbances and prone to sideslip during exercise.
解决以上问题及缺陷的难度为:由于球形机器人结构比较复杂,要想很好地解决现有技术存在的问题,满足实际工程需要,还有很多的困难。如为实现爬坡和越障,必须打破球形机器人传统的驱动方式和结构设计方案,对机器人结构进行创新设计。另外,为实现球形机器人精确控制,就需要克服参数不确定性和系统未知的摩擦等干扰因素,对球形机器人的控制策略进行创新设计,建立一套稳定的闭环控制系统。The difficulty of solving the above problems and defects is: due to the complex structure of the spherical robot, there are still many difficulties in order to solve the problems existing in the prior art and meet the actual engineering needs. For example, in order to realize climbing and overcoming obstacles, it is necessary to break the traditional driving mode and structural design scheme of the spherical robot, and carry out innovative design of the robot structure. In addition, in order to realize the precise control of the spherical robot, it is necessary to overcome the interference factors such as parameter uncertainty and unknown friction of the system, innovate the control strategy of the spherical robot, and establish a stable closed-loop control system.
解决以上问题及缺陷的意义为:由于球形机器人在星球探索、危险环境探测、管道内部探测等领域具有显著优势和广泛应用前景。因此设计一款拥有良好结构特性的球形机器人并且对其实现精确的运动控制具有重要的理论研究意义和工程应用价值。The significance of solving the above problems and defects is that the spherical robot has significant advantages and broad application prospects in the fields of planetary exploration, dangerous environment detection, and pipeline internal detection. Therefore, designing a spherical robot with good structural characteristics and realizing precise motion control has important theoretical research significance and engineering application value.
发明内容Contents of the invention
针对现有技术存在的问题,本发明提供了一种可重构球形机器人、控制系统及其控制方法。Aiming at the problems existing in the prior art, the invention provides a reconfigurable spherical robot, a control system and a control method thereof.
本发明是这样实现的,一种可重构球形机器人包括驱动机构、中心伸展机构和环形足;The present invention is achieved in that a reconfigurable spherical robot includes a driving mechanism, a central stretching mechanism and a circular foot;
所述驱动机构包括两套单摆锤驱动机构,用于为机器人移动提供动力,所述两套单摆锤驱动机构相对于球心面对称,分别装配在中心伸展机构的两侧;The drive mechanism includes two sets of single-pendulum drive mechanisms for providing power for the movement of the robot. The two sets of single-pendulum drive mechanisms are symmetrical with respect to the spherical center plane and are respectively assembled on both sides of the central stretching mechanism;
所述中心伸展机构外端与环形足连接,用于带动环形足的伸出和复位;The outer end of the central stretching mechanism is connected with the ring foot, which is used to drive the extension and reset of the ring foot;
所述环形足设置有相同的多个,多个环形足外表面组成球壳结构。The annular feet are provided with the same plurality, and the outer surfaces of the plurality of annular feet form a spherical shell structure.
进一步,所述单摆锤驱动机构包括直流伺服电机、电机套、摆锤、法兰盘、滚动轴承、丝杠和轴承挡圈;Further, the single pendulum driving mechanism includes a DC servo motor, a motor sleeve, a pendulum, a flange, a rolling bearing, a lead screw and a bearing retaining ring;
所述直流伺服电机与电机套通过螺钉连接在一起,所述直流伺服电机和摆锤固定连接,所述电机套外壳和两个轴承内圈过盈配合,并通过螺栓与球壳固连在一起。The DC servo motor and the motor sleeve are connected together by screws, the DC servo motor and the pendulum are fixedly connected, the outer shell of the motor sleeve and the inner rings of the two bearings have an interference fit, and are fixedly connected to the spherical shell by bolts .
进一步,所述直流伺服电机和摆锤通过法兰盘、缓冲垫连接。Further, the DC servo motor and the pendulum are connected through a flange and a buffer pad.
进一步,所述摆锤包括丝杠、直线电机和偏心质量块,所述偏心质量块与直线电机下端固定连接。Further, the pendulum includes a lead screw, a linear motor and an eccentric mass, and the eccentric mass is fixedly connected to the lower end of the linear motor.
进一步,所述中心伸展机构包括舵机、圆柱凸轮结构、多功能支架、结构外壳、腿部连接件以及电池箱,所述舵机通过多功能支架与电池箱固连在一起,舵机通过法兰盘与圆柱凸轮机构连接。Further, the central extension mechanism includes a steering gear, a cylindrical cam structure, a multifunctional bracket, a structural shell, leg connectors, and a battery box. The steering gear is fixedly connected to the battery box through a multifunctional bracket. The blue disc is connected with the cylindrical cam mechanism.
进一步,所述环形足包括弧形壳体、第一连接件、第二连接件和第三连接件;Further, the annular foot includes an arc-shaped housing, a first connecting piece, a second connecting piece and a third connecting piece;
所述第一连接件与第二连接件通过螺栓固连在一起,实现圆柱凸轮机构与球壳的连接和控制;The first connecting piece and the second connecting piece are fixed together by bolts to realize the connection and control of the cylindrical cam mechanism and the spherical shell;
所述弧形壳体上加工有螺纹凸台,第三连接件通过螺栓与螺纹凸台连接。A threaded boss is processed on the arc-shaped housing, and the third connecting piece is connected to the threaded boss through bolts.
本发明的另一目的在于提供一种可重构球形机器人的控制系统,所述可重构机器人的控制系统包括视觉模块、姿态调整模块、控制模块、惯性模块和机载电源;Another object of the present invention is to provide a control system for a reconfigurable spherical robot, which includes a vision module, an attitude adjustment module, a control module, an inertial module, and an onboard power supply;
所述视觉模块安装在两侧的球壳外侧,用于感知外部环境和路况;The vision module is installed on the outside of the spherical shell on both sides for sensing the external environment and road conditions;
所述姿态调整模块用于感知摆锤的摆角、机器人的姿态、运动速度信息;The attitude adjustment module is used to perceive the swing angle of the pendulum, the attitude of the robot, and the movement speed information;
所述控制模块以及惯性模块安装在两侧的球壳内部,机载电源布置在中心伸展机构内侧。惯性模块是可移动质量块,用来保证球体运行过程中的稳定性,或者说是调整球体的重心位置。The control module and the inertial module are installed inside the spherical shells on both sides, and the onboard power supply is arranged inside the central extension mechanism. The inertia module is a movable mass block, which is used to ensure the stability of the sphere during operation, or to adjust the position of the center of gravity of the sphere.
本发明的另一目的在于提供一种可重构球形机器人的控制方法,所述可重构机器人的控制方法包括:Another object of the present invention is to provide a control method of a reconfigurable spherical robot, the control method of the reconfigurable robot includes:
(1)光滑路面的运动方式:(1) Movement mode on smooth road:
机器人在平滑路面行驶时,安装在球壳两端的两个直流伺服电机分别驱动与之相连的偏心质量块,当两个偏心质量块同时向前摆动时,球形机器人向前移动,当两个偏心质量块同时向后摆动时,球形机器人向后移动,当一个偏心质量块不动,一个质量块摆动,可实现转弯;控制包括两方面:(1)行走路径的精确控制。由于球形机器人在行进过程中,受外界环境因素的影响,球形机器人行走路径容易偏离原定路径。通过定位模块实时检测球形机器人与地面接触点的位置,计算参考几何路径和球形机器人实际行走路径的偏差,将偏差值作为反馈量来不断调整惯性模块(质量块)的位置,使得球形滚动机器人的路径跟踪误差接近零;(2)运动方式的精确控制。由于滚动过程中球形机器人受到滚动摩阻力偶矩的影响,机器人始终处于动态平衡状态,机器人很难按照原定的运动规律(加速、减速、匀速)行进。通过力矩传感器和姿态传感器实时监测球形机器人的滚动摩阻力偶矩和重摆摆起平衡角,依据滚动摩阻力偶矩和重摆摆起平衡角的动态变化关系,实时调整摆锤电机的输出扭矩,确保机器人按照原定的运动规律(加速、减速、匀速)行进,实现球形机器人精准控制。When the robot is running on a smooth road, two DC servo motors installed at both ends of the spherical shell respectively drive the eccentric masses connected to it. When the two eccentric masses swing forward at the same time, the spherical robot moves forward. When the two eccentric masses When the mass blocks swing backward simultaneously, the spherical robot moves backward. When one eccentric mass block does not move, the other mass block swings to realize turning; the control includes two aspects: (1) precise control of the walking path. Due to the influence of external environmental factors during the traveling process of the spherical robot, the walking path of the spherical robot tends to deviate from the original path. The positioning module detects the position of the contact point between the spherical robot and the ground in real time, calculates the deviation between the reference geometric path and the actual walking path of the spherical robot, and uses the deviation value as the feedback to continuously adjust the position of the inertial module (mass block), so that the spherical rolling robot The path tracking error is close to zero; (2) The precise control of the motion mode. Because the spherical robot is affected by the rolling frictional moment during the rolling process, the robot is always in a state of dynamic balance, and it is difficult for the robot to move according to the original law of motion (acceleration, deceleration, uniform speed). Real-time monitoring of the rolling friction moment and the balance angle of the heavy pendulum of the spherical robot through the torque sensor and the attitude sensor, and real-time adjustment of the output torque of the pendulum motor according to the dynamic change relationship between the rolling friction resistance moment and the balance angle of the heavy pendulum , to ensure that the robot moves according to the original law of motion (acceleration, deceleration, uniform speed), and realize the precise control of the spherical robot.
(2)爬坡方式:(2) Climbing mode:
当机器人爬坡时,中心伸展机构的六个舵机分别带动相应的圆柱凸轮机构旋转,将6条环形足同时伸出,形成类履带式环形机构;当机器人的定位模块检测到球形机器人与地面接触点连续10次沿地面垂直方向的数值增加时,即判定为球形机器人行走的是斜坡路段,并将信号传送给控制系统,控制系统发出指令,由中心伸展机构的六个舵机分别带动相应的圆柱凸轮机构旋转,将6条环形足同时伸出,形成类履带式环形机构。同时,控制系统依据球形机器人与地面接触点的坐标值,计算重力偏心距的大小,并与机器人的滚动摩阻力偶矩耦合,计算出重摆需要摆起的平衡角,调整摆锤电机的输出扭矩。When the robot climbs a slope, the six steering gears of the central extension mechanism respectively drive the corresponding cylindrical cam mechanism to rotate, and extend the six annular feet simultaneously to form a crawler-like annular mechanism; when the positioning module of the robot detects that the spherical robot is in contact with the ground When the value of the contact point along the vertical direction of the ground increases continuously for 10 times, it is determined that the spherical robot is walking on a slope section, and the signal is sent to the control system. The control system issues instructions, and the six steering gears of the central extension mechanism drive the corresponding The cylindrical cam mechanism rotates, and the six annular feet are simultaneously extended to form a crawler-like annular mechanism. At the same time, the control system calculates the size of the gravity eccentricity based on the coordinates of the contact point between the spherical robot and the ground, and couples with the rolling frictional moment of the robot to calculate the balance angle that the heavy pendulum needs to swing up, and adjust the output of the pendulum motor torque.
(3)越障方式:(3) Ways to overcome obstacles:
当机器人跨越台阶时,安装在球形机器人上的视觉传感器检测到台阶的轮廓形状,并将信号传递给控制系统,控制靠近台阶环形足的舵机,依据台阶的高度,将靠近台阶的环形足伸出,控制系统控制与靠近台阶环形足间隔60度的另一环形足伸出,从而实现越障。控制系统依据台阶的高度,计算翻越台阶所需的转矩,与远离台阶的环形足产生的力矩耦合,计算出需要重摆产生的力矩,调整摆锤电机的输出扭矩,实现越障。When the robot crosses the steps, the visual sensor installed on the spherical robot detects the contour shape of the steps and transmits the signal to the control system to control the servos close to the ring feet of the steps, and extend the ring feet close to the steps according to the height of the steps. Out, the control system controls the extension of another ring foot that is 60 degrees away from the ring foot close to the step, so as to achieve obstacle surmounting. Based on the height of the steps, the control system calculates the torque required to climb over the steps, couples with the torque generated by the ring foot far away from the steps, calculates the torque required to re-swing, adjusts the output torque of the pendulum motor, and achieves obstacle surmounting.
本发明的另一目的在于提供一种计算机可读存储介质,存储有计算机程序,所述计算机程序被处理器执行时,使得所述处理器执行所述的可重构球形机器人的控制方法。Another object of the present invention is to provide a computer-readable storage medium storing a computer program. When the computer program is executed by a processor, the processor executes the control method of the reconfigurable spherical robot.
本发明的另一目的在于提供一种信息数据处理终端,所述信息数据处理终端包括存储器和处理器,所述存储器存储有计算机程序,所述计算机程序被所述处理器执行时,使得所述处理器执行所述的可重构球形机器人的控制方法。Another object of the present invention is to provide an information data processing terminal, the information data processing terminal includes a memory and a processor, the memory stores a computer program, and when the computer program is executed by the processor, the The processor executes the control method of the reconfigurable spherical robot.
结合上述的所有技术方案,本发明所具备的优点及积极效果为:In combination with all the above-mentioned technical solutions, the advantages and positive effects of the present invention are:
与传统的球形机器人相比,本发明具有独特的外部轮廓变换状态,使得机器人可以在不同环境下工作。在平滑的路面上,机器人以球形状态滚动前行;当机器人在崎岖不平等复杂路况运动时,机器人可变形为类履带式环形机构,增大机构与地面的接触面积,提升机构的环境适应能力。当翻越台阶式,独特的环形足调整伸缩状态实现越障。Compared with the traditional spherical robot, the invention has a unique external contour transformation state, so that the robot can work in different environments. On a smooth road, the robot rolls forward in a spherical state; when the robot moves on rough and uneven road conditions, the robot can be transformed into a crawler-like ring mechanism, which increases the contact area between the mechanism and the ground and improves the environmental adaptability of the mechanism . When climbing over steps, the unique ring foot adjusts the telescopic state to overcome obstacles.
针对外界扰动和地面环境等因素对球形机器人精准运行产生的影响,引入非线性摩擦模型和自适应率进行反馈控制,以确保系统高的响应性和强鲁棒性,实现球形机器人精准的路径和运动状态控制。In view of the influence of factors such as external disturbance and ground environment on the precise operation of the spherical robot, a nonlinear friction model and adaptive rate are introduced for feedback control to ensure high responsiveness and robustness of the system, and realize the precise path and Motion state control.
附图说明Description of drawings
为了更清楚地说明本申请实施例的技术方案,下面将对本申请实施例中所需要使用的附图做简单的介绍,显而易见地,下面所描述的附图仅仅是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions of the embodiments of the present application, the following will briefly introduce the accompanying drawings required in the embodiments of the present application. Obviously, the accompanying drawings described below are only some embodiments of the present application. Those of ordinary skill in the art can also obtain other drawings based on these drawings without making creative efforts.
图1是本发明实施例提供的可重构球形机器人的结构示意图。Fig. 1 is a schematic structural diagram of a reconfigurable spherical robot provided by an embodiment of the present invention.
图2是本发明实施例提供的驱动机构的结构示意图。Fig. 2 is a schematic structural diagram of a driving mechanism provided by an embodiment of the present invention.
图3是本发明实施例提供的中心伸展机构的结构示意图。Fig. 3 is a schematic structural view of the central stretching mechanism provided by the embodiment of the present invention.
图4是本发明实施例提供的环形足的结构示意图。Fig. 4 is a schematic structural diagram of the ring foot provided by the embodiment of the present invention.
图5是本发明实施例提供的可重构球形机器人在光滑路面的运动方式示意图。Fig. 5 is a schematic diagram of the movement mode of the reconfigurable spherical robot provided by the embodiment of the present invention on a smooth road.
图6是本发明实施例提供的可重构球形机器人的爬坡方式示意图。Fig. 6 is a schematic diagram of the climbing mode of the reconfigurable spherical robot provided by the embodiment of the present invention.
图7是本发明实施例提供的可重构球形机器人的越障方式示意图。Fig. 7 is a schematic diagram of the obstacle-surmounting method of the reconfigurable spherical robot provided by the embodiment of the present invention.
图中:1、球壳;2、驱动机构;3、中心伸展机构;4、环形足;5、直流伺服电机;6、电机套;7、轴承;8、法兰盘;9、偏心质量块;10、直线电机;11、丝杠;12、缓冲垫;13、舵机;14、圆柱凸轮结构;15、电池箱;16、多功能支架;17、腿部连接件;18、弧形壳体;19、第一连接件;20、第二连接件;21、第三连接件。In the figure: 1. Spherical shell; 2. Driving mechanism; 3. Central stretching mechanism; 4. Ring foot; 5. DC servo motor; 6. Motor sleeve; 7. Bearing; 8. Flange; 9. Eccentric mass block ;10. Linear motor; 11. Lead screw; 12. Cushion pad; 13. Steering gear; 14. Cylindrical cam structure; 15. Battery box; 16. Multifunctional bracket; 17. Leg connector; 18. Arc shell Body; 19, the first connecting piece; 20, the second connecting piece; 21, the third connecting piece.
具体实施方式Detailed ways
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅仅用以解释本发明,并不用于限定本发明。In order to make the object, technical solution and advantages of the present invention more clear, the present invention will be further described in detail below in conjunction with the examples. It should be understood that the specific embodiments described here are only used to explain the present invention, not to limit the present invention.
针对现有技术存在的问题,本发明提供了一种可重构球形机器人、控制系统及其控制方法,下面结合附图对本发明作详细的描述。Aiming at the problems existing in the prior art, the present invention provides a reconfigurable spherical robot, a control system and a control method thereof. The present invention will be described in detail below with reference to the accompanying drawings.
如图1所示,本发明实施例提供的可重构球形机器人主要由驱动机构2、中心伸展机构3、球壳1、环形足4组成。As shown in FIG. 1 , the reconfigurable spherical robot provided by the embodiment of the present invention is mainly composed of a
驱动机构2通过螺栓分别与两侧球壳1连接,对称地布置在中心伸展机构3两侧。两侧球壳1内部设有凸台,便于内部各机构的安装。The
本发明实施例中的驱动机构2由两套单摆锤驱动机构组成。两套单摆锤驱动机构相对于球心面对称,分别装配在中心伸展机构3的两侧。单摆锤驱动机构如图2所示,包括直流伺服电机5、电机套6、摆锤、法兰盘8、轴承7、丝杠11、轴承挡圈。两套单摆锤驱动机构的直流伺服电机5与电机套6通过螺钉连接在一起,直流伺服电机5和摆锤通过法兰盘、缓冲垫固定连接,电机套6外壳和两轴承内圈过盈配合,并通过螺栓与球壳1固连在一起,其中缓冲垫能够产生一定的形变,起到保护电机轴不受扭矩冲击,调节同心度的作用。The
本发明实施例中的摆锤包括丝杠、直线电机和偏心质量块,所述偏心质量块与直线电机下端固定连接。The pendulum in the embodiment of the present invention includes a lead screw, a linear motor and an eccentric mass, and the eccentric mass is fixedly connected to the lower end of the linear motor.
当电机启动后由于电机和电机套固定,在联轴器作用下,摆锤通过轴承实现相对旋转运动,机器人所处的环境不同所需要的驱动力矩也不同,控制器通过控制直线电机使偏心质量块在丝杠导轨上下移动,从而调节惯性力矩的大小,实现球形机器人平稳运动。When the motor starts, because the motor and the motor sleeve are fixed, under the action of the coupling, the pendulum achieves relative rotation through the bearing. The driving torque required by the different environments of the robot is also different. The controller controls the linear motor to make the eccentric mass The block moves up and down on the lead screw guide rail, thereby adjusting the size of the moment of inertia and realizing the smooth movement of the spherical robot.
如图3所示,本发明实施例中的中心伸展机构结构包括舵机13、圆柱凸轮结构14、多功能支架16、结构外壳、腿部连接件17以及电池箱15等主要部件,舵机13通过多功能支架16与电池箱15固连在一起,舵机13通过法兰盘与圆柱凸轮机构14连接。As shown in Figure 3, the central stretching mechanism structure in the embodiment of the present invention comprises main components such as
如图4所示,本发明实施例中的环形足结构结构包括弧形壳体18、第一连接件19、第二连接件20和第三连接件21。第一连接件19与第二连接件20通过螺栓固连在一起,实现圆柱凸轮机构与球壳的连接和控制。弧形壳体18上加工有螺纹凸台,第三连接件21通过螺栓与螺纹凸台连接。As shown in FIG. 4 , the annular foot structure in the embodiment of the present invention includes an arc-shaped
本发明实施例提供的可重构机器人的控制系统包括:视觉模块、姿态调整模块、控制模块和机载电源等。视觉模块安装在两侧的球壳1外侧,控制模块以及惯性模块安装在两侧的球壳1内部,机载电源布置在中心伸展机构内侧。视觉模块主要感知外部环境和路况,姿态调整模块主要感知摆锤的摆角、机器人的姿态、运动速度信息。当机器人工作时,控制模块根据视觉模块和姿态调整模块传递的信息实时调整球形机器人的外部轮廓和姿态,并根据遇到障碍物的高低大小决定舵机旋转角度。The control system of the reconfigurable robot provided by the embodiment of the present invention includes: a vision module, an attitude adjustment module, a control module, and an onboard power supply. The vision module is installed outside the
本发明实施例提供的可重构球形机器人的控制方法,包括:The control method of the reconfigurable spherical robot provided by the embodiment of the present invention includes:
(1)光滑路面的运动方式:(1) Movement mode on smooth road:
如图5所示,机器人在平滑路面行驶时,安装在球壳两端的两个直流伺服电机分别驱动与之相连的偏心质量块,当两个偏心质量块同时向前摆动时,球形机器人向前移动,当两个偏心质量块同时向后摆动时,球形机器人向后移动,当一个偏心质量块不动,一个质量块摆动,可实现转弯;控制包括两方面:(1)行走路径的精确控制。由于球形机器人在行进过程中,受外界环境因素的影响,球形机器人行走路径容易偏离原定路径。通过定位模块实时检测球形机器人与地面接触点的位置,计算参考几何路径和球形机器人实际行走路径的偏差,将偏差值作为反馈量来不断调整惯性模块(质量块)的位置,使得球形滚动机器人的路径跟踪误差接近零;(2)运动方式的精确控制。由于滚动过程中球形机器人受到滚动摩阻力偶矩的影响,机器人始终处于动态平衡状态,机器人很难按照原定的运动规律(加速、减速、匀速)行进。通过力矩传感器和姿态传感器实时监测球形机器人的滚动摩阻力偶矩和重摆摆起平衡角,依据滚动摩阻力偶矩和重摆摆起平衡角的动态变化关系,实时调整摆锤电机的输出扭矩,确保机器人按照原定的运动规律(加速、减速、匀速)行进,实现球形机器人精准控制。As shown in Figure 5, when the robot is driving on a smooth road, two DC servo motors installed at both ends of the spherical shell drive the eccentric masses connected to it respectively. When the two eccentric masses swing forward at the same time, the spherical robot moves forward. To move, when two eccentric mass blocks swing backward at the same time, the spherical robot moves backward. When one eccentric mass block does not move, the other mass block swings to realize turning; control includes two aspects: (1) Precise control of walking path . Due to the influence of external environmental factors during the traveling process of the spherical robot, the walking path of the spherical robot tends to deviate from the original path. The positioning module detects the position of the contact point between the spherical robot and the ground in real time, calculates the deviation between the reference geometric path and the actual walking path of the spherical robot, and uses the deviation value as the feedback to continuously adjust the position of the inertial module (mass block), so that the spherical rolling robot The path tracking error is close to zero; (2) The precise control of the motion mode. Because the spherical robot is affected by the rolling frictional moment during the rolling process, the robot is always in a state of dynamic balance, and it is difficult for the robot to move according to the original law of motion (acceleration, deceleration, uniform speed). Real-time monitoring of the rolling friction moment and the balance angle of the heavy pendulum of the spherical robot through the torque sensor and the attitude sensor, and real-time adjustment of the output torque of the pendulum motor according to the dynamic change relationship between the rolling friction resistance moment and the balance angle of the heavy pendulum , to ensure that the robot moves according to the original law of motion (acceleration, deceleration, uniform speed), and realize the precise control of the spherical robot.
(2)爬坡方式:(2) Climbing mode:
如图6所示,当机器人爬坡时,中心伸展机构的六个舵机分别带动相应的圆柱凸轮机构旋转,将6条环形足同时伸出,形成类履带式环形机构;当机器人的定位模块检测到球形机器人与地面接触点连续10次沿地面垂直方向的数值增加时,即判定为球形机器人行走的是斜坡路段,并将信号传送给控制系统,控制系统发出指令,由中心伸展机构的六个舵机分别带动相应的圆柱凸轮机构旋转,将6条环形足同时伸出,形成类履带式环形机构。同时,控制系统依据球形机器人与地面接触点的坐标值,计算重力偏心距的大小,并与机器人的滚动摩阻力偶矩耦合,计算出重摆需要摆起的平衡角,调整摆锤电机的输出扭矩。As shown in Figure 6, when the robot climbs a slope, the six steering gears of the central extension mechanism respectively drive the corresponding cylindrical cam mechanism to rotate, and extend the six annular feet simultaneously to form a crawler-like annular mechanism; when the positioning module of the robot When it is detected that the value of the contact point between the spherical robot and the ground increases vertically for 10 consecutive times, it is determined that the spherical robot is walking on a slope section, and the signal is sent to the control system. Each steering gear respectively drives the corresponding cylindrical cam mechanism to rotate, and simultaneously protrudes six annular feet to form a crawler-like annular mechanism. At the same time, the control system calculates the size of the gravity eccentricity based on the coordinates of the contact point between the spherical robot and the ground, and couples with the rolling frictional moment of the robot to calculate the balance angle that the heavy pendulum needs to swing up, and adjust the output of the pendulum motor torque.
(3)越障方式:(3) Ways to overcome obstacles:
如图7所示,当机器人跨越台阶时,安装在球形机器人上的视觉传感器检测到台阶的轮廓形状,并将信号传递给控制系统,控制靠近台阶环形足的舵机,依据台阶的高度,将靠近台阶的环形足伸出,控制系统控制与靠近台阶环形足间隔60度的另一环形足伸出,从而实现越障。控制系统依据台阶的高度,计算翻越台阶所需的转矩,与远离台阶的环形足产生的力矩耦合,计算出需要重摆产生的力矩,调整摆锤电机的输出扭矩,实现越障。As shown in Figure 7, when the robot crosses the steps, the visual sensor installed on the spherical robot detects the contour shape of the steps and transmits the signal to the control system to control the steering gear close to the ring foot of the steps. The annular foot close to the step stretches out, and the control system controls another annular foot at a distance of 60 degrees from the annular foot close to the step to stretch out, thereby realizing obstacle surmounting. Based on the height of the steps, the control system calculates the torque required to climb over the steps, couples with the torque generated by the ring foot far away from the steps, calculates the torque required to re-swing, adjusts the output torque of the pendulum motor, and achieves obstacle surmounting.
在本发明的描述中,除非另有说明,“多个”的含义是两个或两个以上;术语“上”、“下”、“左”、“右”、“内”、“外”、“前端”、“后端”、“头部”、“尾部”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”等仅用于描述目的,而不能理解为指示或暗示相对重要性。In the description of the present invention, unless otherwise stated, the meaning of "plurality" is two or more; the terms "upper", "lower", "left", "right", "inner", "outer" , "front end", "rear end", "head", "tail", etc. indicate the orientation or positional relationship based on the orientation or positional relationship shown in the drawings, and are only for the convenience of describing the present invention and simplifying the description, rather than Nothing indicating or implying that a referenced device or element must have a particular orientation, be constructed, and operate in a particular orientation should therefore not be construed as limiting the invention. In addition, the terms "first", "second", "third", etc. are used for descriptive purposes only and should not be construed as indicating or implying relative importance.
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,凡在本发明的精神和原则之内所作的任何修改、等同替换和改进等,都应涵盖在本发明的保护范围之内。The above is only a specific embodiment of the present invention, but the scope of protection of the present invention is not limited thereto. Anyone familiar with the technical field within the technical scope disclosed in the present invention, whoever is within the spirit and principles of the present invention Any modifications, equivalent replacements and improvements made within shall fall within the protection scope of the present invention.
Claims (5)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111090499.6A CN113788082B (en) | 2021-09-17 | 2021-09-17 | Reconfigurable spherical robot, control system and control method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111090499.6A CN113788082B (en) | 2021-09-17 | 2021-09-17 | Reconfigurable spherical robot, control system and control method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113788082A CN113788082A (en) | 2021-12-14 |
CN113788082B true CN113788082B (en) | 2023-03-24 |
Family
ID=79183697
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111090499.6A Active CN113788082B (en) | 2021-09-17 | 2021-09-17 | Reconfigurable spherical robot, control system and control method thereof |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113788082B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN115056868B (en) * | 2022-05-16 | 2024-07-23 | 王维 | Obstacle crossing method of travelling device and travelling device applying method |
CN114939877B (en) * | 2022-05-18 | 2023-11-10 | 北京邮电大学 | A mobile operating spherical robot for lunar base construction |
CN115535106B (en) * | 2022-09-27 | 2023-08-15 | 西南科技大学 | Deformable obstacle-surmounting spherical robot |
CN115636029B (en) * | 2022-10-20 | 2024-10-15 | 厦门大学 | Climbing robot and foot wheel thereof |
Family Cites Families (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
SE0402672D0 (en) * | 2004-11-02 | 2004-11-02 | Viktor Kaznov | Ball robot |
CN201951167U (en) * | 2011-03-18 | 2011-08-31 | 何穗宁 | Sand sinking resistance structure of novel probe vehicle |
CN103171645B (en) * | 2013-04-19 | 2015-06-10 | 吉林大学 | Hexapod robot capable of travelling in rolling manner |
CN103963556A (en) * | 2014-04-30 | 2014-08-06 | 占舒婷 | Deformable wheel |
CN107284543A (en) * | 2017-06-28 | 2017-10-24 | 青岛港湾职业技术学院 | A kind of compound motion mechanical ball |
CN109677494B (en) * | 2018-12-26 | 2021-07-20 | 广西大学 | A Deformable Spherical Robot with Adaptive Steering and Climbing |
CN111361355B (en) * | 2020-03-22 | 2023-04-18 | 吉林大学 | Bionic walking wheel for climbing ladder device |
-
2021
- 2021-09-17 CN CN202111090499.6A patent/CN113788082B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN113788082A (en) | 2021-12-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113788082B (en) | Reconfigurable spherical robot, control system and control method thereof | |
CN111949039B (en) | A hexapod robot heading control method based on semicircular bionic blade legs | |
CN111290272B (en) | Attitude stationarity adjusting method based on multi-legged robot | |
CN106873645B (en) | Spherical gyro mechanism capable of omnidirectional precession and control method | |
CN103879467B (en) | The differential mobile robot platform of a kind of passive self adaptation crawler belt deformable rocking bar | |
CN103273977A (en) | Passive self-adaption deformable continuous track type mobile robot platform | |
CN106828643A (en) | A kind of omni-directional movement ball shape robot | |
CN106379409A (en) | Angle-controllable power differential omnidirectional wheel, and control method and omnidirectional moving platform thereof | |
CN112936241B (en) | A snake-like robot | |
Chen et al. | Design and motion control of a spherical robot with control moment gyroscope | |
CN111746824A (en) | A buffer/walking integrated hexapod lander and its gait control method | |
CN107226144A (en) | A kind of mechanical gyroscope structure ball shape robot | |
CN108639181A (en) | A kind of multiple degrees of freedom four-leg bionic robot | |
Arif et al. | Design of an amphibious spherical robot driven by twin eccentric pendulums with flywheel-based inertial stabilization | |
Mao et al. | A spherical mobile robot driven by eccentric pendulum and self-stabilizing by flywheel | |
CN102114879B (en) | Biped walking four-bar mechanism | |
Wu et al. | Research on the design of educational robot with four-wheel omni-direction chassis | |
CN104029742A (en) | Novel spherical robot and control method thereof | |
Jia et al. | Toward a novel deformable robot mechanism to transition between spherical rolling and quadruped walking | |
CN110587618B (en) | Self-balancing motion platform driven by double ball wheels | |
CN117022485B (en) | rolling robot | |
CN103612254B (en) | A load-carrying robot driven by inertial wheels | |
CN114987646B (en) | A bionic four-foot-legged composite robot and its working method | |
CN110524510A (en) | A kind of cube one-wheel robot | |
CN205345104U (en) | Spherical robot with double pendulum hammer |
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 |