CN111506054B - Automatic guiding method of 4WID-4WIS robot chassis - Google Patents
Automatic guiding method of 4WID-4WIS robot chassis Download PDFInfo
- Publication number
- CN111506054B CN111506054B CN201910100209.8A CN201910100209A CN111506054B CN 111506054 B CN111506054 B CN 111506054B CN 201910100209 A CN201910100209 A CN 201910100209A CN 111506054 B CN111506054 B CN 111506054B
- Authority
- CN
- China
- Prior art keywords
- wheel
- robot
- robot chassis
- chassis
- 4wis
- 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
- 238000000034 method Methods 0.000 title claims abstract description 43
- 230000033001 locomotion Effects 0.000 claims abstract description 50
- 230000008569 process Effects 0.000 claims abstract description 19
- 230000001133 acceleration Effects 0.000 claims description 16
- 239000013598 vector Substances 0.000 claims description 13
- 239000003638 chemical reducing agent Substances 0.000 claims description 11
- 230000001681 protective effect Effects 0.000 claims description 11
- 230000005540 biological transmission Effects 0.000 claims description 9
- 230000008878 coupling Effects 0.000 claims description 7
- 238000010168 coupling process Methods 0.000 claims description 7
- 238000005859 coupling reaction Methods 0.000 claims description 7
- 238000005259 measurement Methods 0.000 claims description 7
- 230000002441 reversible effect Effects 0.000 claims description 2
- 230000000694 effects Effects 0.000 abstract description 5
- 230000002411 adverse Effects 0.000 abstract description 3
- 238000004364 calculation method Methods 0.000 description 7
- 238000004422 calculation algorithm Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000006870 function Effects 0.000 description 5
- 230000004044 response Effects 0.000 description 5
- 238000004891 communication Methods 0.000 description 4
- 238000005070 sampling Methods 0.000 description 4
- 101000827703 Homo sapiens Polyphosphoinositide phosphatase Proteins 0.000 description 2
- 102100023591 Polyphosphoinositide phosphatase Human genes 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 2
- 230000015572 biosynthetic process Effects 0.000 description 2
- 238000013461 design Methods 0.000 description 2
- 238000001914 filtration Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 238000003786 synthesis reaction Methods 0.000 description 2
- 101001121408 Homo sapiens L-amino-acid oxidase Proteins 0.000 description 1
- 102100026388 L-amino-acid oxidase Human genes 0.000 description 1
- 101100012902 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) FIG2 gene Proteins 0.000 description 1
- 101100233916 Saccharomyces cerevisiae (strain ATCC 204508 / S288c) KAR5 gene Proteins 0.000 description 1
- 230000010391 action planning Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000006243 chemical reaction Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000008094 contradictory effect Effects 0.000 description 1
- 230000001186 cumulative effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000007774 longterm Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 238000002156 mixing Methods 0.000 description 1
- 230000008447 perception Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
- G05D1/0238—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors
- G05D1/024—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means using obstacle or wall sensors in combination with a laser
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0223—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0225—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving docking at a fixed facility, e.g. base station or loading bay
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0257—Control of position or course in two dimensions specially adapted to land vehicles using a radar
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Aviation & Aerospace Engineering (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Optics & Photonics (AREA)
- Electromagnetism (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明涉及一种4WID‑4WIS机器人底盘的自动导引方法,所述机器人底盘设有四个轮组,该方法包括:1、获得机器人当前的位置定位;2、获得从当前位置到达目标位置的全局路径,获得局部区域的目标点与局部路径,根据局部路径得到接下来一段时间内机器人的运动参数;3、根据机器人的运动参数,以机器人底盘中心为原点建立直角坐标系,得到四个轮组各自的控制指令;4、通过运动学逆解算得到机器人底盘的实际运动情况,并根据四个轮组的实际运动情况调整四个轮组的协同控制过程。与现有技术相比,本发明实现对四个轮组的协同控制,尽可能避免由于控制指令与轮组的不适应而带来的不利影响,提高机器人控制的准确性。
The present invention relates to an automatic guidance method for a 4WID‑4WIS robot chassis, wherein the robot chassis is provided with four wheel groups, and the method comprises: 1. obtaining the current position of the robot; 2. obtaining a global path from the current position to the target position, obtaining the target point and the local path in the local area, and obtaining the motion parameters of the robot in the next period of time according to the local path; 3. establishing a rectangular coordinate system with the center of the robot chassis as the origin according to the motion parameters of the robot, and obtaining the control instructions of each of the four wheel groups; 4. obtaining the actual motion of the robot chassis by inverse kinematics solution, and adjusting the coordinated control process of the four wheel groups according to the actual motion of the four wheel groups. Compared with the prior art, the present invention realizes the coordinated control of the four wheel groups, avoids the adverse effects caused by the incompatibility of the control instructions with the wheel groups as much as possible, and improves the accuracy of robot control.
Description
技术领域Technical Field
本发明涉及机器人技术领域,尤其是涉及一种4WID-4WIS机器人底盘的自动导引方法。The present invention relates to the field of robot technology, and in particular to an automatic guiding method of a 4WID-4WIS robot chassis.
背景技术Background Art
ROS(Robot Operating System)是一个机器人软件平台,ROS可以分成两层,低层是操作系统层,高层则是广大用户群贡献的实现不同功能的各种软件包,例如定位绘图、行动规划、感知、模拟等等。ROS (Robot Operating System) is a robot software platform. ROS can be divided into two layers. The lower layer is the operating system layer, and the higher layer is various software packages contributed by a large user base to achieve different functions, such as positioning mapping, action planning, perception, simulation, etc.
ROS低层使用BSD许可证,所以是开源软件,并能免费用于研究和商业用途。而高层的用户提供的包则可以使用很多种不同的许可证。The low-level ROS uses the BSD license, so it is open source software and can be used for research and commercial purposes free of charge. The high-level user-provided packages can use many different licenses.
机器人的移动重点包括用于下发的运动学解算与用于反馈的运动学逆解算上。对于传统的导航算法模型,最终的控制目标是将车体当作一个质点,通过给出对这一质点在三维空间中,沿三条坐标轴的线速度与角速度完成命令的下发。对于常见的二轮或是全向论结构,其车体的自旋与前进、转向等过程可以无缝切换,同时,其对于角速度变化的响应可以直接对应到电机的调速控制上,进而近乎实时的完成目标控制。The focus of robot movement includes kinematic solutions for sending commands and inverse kinematic solutions for feedback. For traditional navigation algorithm models, the ultimate control goal is to treat the vehicle body as a point mass, and complete the issuance of commands by giving the linear velocity and angular velocity of this point mass along the three coordinate axes in three-dimensional space. For common two-wheel or omnidirectional structures, the body's spin, forward movement, steering and other processes can be seamlessly switched. At the same time, its response to angular velocity changes can be directly mapped to the motor speed control, thereby completing target control in near real time.
然而对于四轮独立驱动-独立转向(4WID-4WIS)体系来说,其改变角速度的过程包括转向电机与驱动电机的协同控制,对于许多控制场景,比如从执行切换为自转时,其转向电机需要预先使驱动电机的方向到位,最终才能执行驱动操作。上述特性使得这一系统的控制往往有其过程性,如何将4WID-4WIS机器人对接一套成熟的实时指令系统就成为一个最大的重点与难点。However, for the four-wheel independent drive-independent steering (4WID-4WIS) system, the process of changing the angular velocity includes the coordinated control of the steering motor and the drive motor. For many control scenarios, such as switching from execution to self-rotation, the steering motor needs to pre-set the direction of the drive motor before the drive operation can be performed. The above characteristics make the control of this system often procedural. How to connect the 4WID-4WIS robot to a mature real-time instruction system has become the biggest focus and difficulty.
机器人的自主导航有相对成熟的开源实现。但是,这些实现方法中,只有针对标准差速型系统与类似万向轮或麦克纳姆轮式结构的设计。此类设计中均有一个特点,也就是系统对目标信号响应的非独占性,而这将成为自主4WIS-4DIS型车架的实现难点,因为这一结构需要多机构的协同运作,甚至是有顺序的前后执行操作。There are relatively mature open source implementations of autonomous robot navigation. However, among these implementation methods, only the standard differential system and the design of the universal wheel or Mecanum wheel structure are targeted. There is a characteristic in all such designs, that is, the non-exclusiveness of the system's response to the target signal, which will become a difficulty in the implementation of the autonomous 4WIS-4DIS frame, because this structure requires the coordinated operation of multiple mechanisms, and even sequential forward and backward execution operations.
发明内容Summary of the invention
本发明的目的就是为了克服上述现有技术存在的缺陷而提供一种4WID-4WIS机器人底盘的自动导引方法。The purpose of the present invention is to provide an automatic guidance method for a 4WID-4WIS robot chassis in order to overcome the defects of the above-mentioned prior art.
本发明的目的可以通过以下技术方案来实现:The purpose of the present invention can be achieved by the following technical solutions:
一种4WID-4WIS机器人底盘的自动导引方法,所述机器人底盘设有四个轮组,该方法包括:An automatic guidance method for a 4WID-4WIS robot chassis, wherein the robot chassis is provided with four wheel sets, the method comprising:
S1、获得机器人当前的位置定位;S1. Get the current position of the robot;
S2、获得从当前位置到达目标位置的全局路径,从全局路径中划分出当前位置周围的局部区域,获得局部区域的目标点与局部路径,根据局部路径得到接下来一段时间内机器人的运动参数;S2, obtain the global path from the current position to the target position, divide the local area around the current position from the global path, obtain the target point and local path of the local area, and obtain the motion parameters of the robot in the next period of time according to the local path;
S3、根据机器人的运动参数,以机器人底盘中心为原点建立直角坐标系,得到四个轮组各自的运动速度、运动方向和自转角速度的控制指令;S3. According to the motion parameters of the robot, a rectangular coordinate system is established with the center of the robot chassis as the origin to obtain control instructions for the motion speed, motion direction and rotation angular velocity of each of the four wheel groups;
S4、根据控制指令控制机器人运动的过程中,采集四个轮组的实际运动情况,通过运动学逆解算得到机器人底盘的实际运动情况,并根据四个轮组的实际运动情况调整四个轮组的协同控制过程。S4. In the process of controlling the movement of the robot according to the control instructions, the actual movement conditions of the four wheel groups are collected, the actual movement conditions of the robot chassis are obtained through inverse kinematics solution, and the coordinated control process of the four wheel groups is adjusted according to the actual movement conditions of the four wheel groups.
优选的,所述运动学逆解算包括线速度逆解算和角速度逆解算。Preferably, the kinematic inverse solution includes linear velocity inverse solution and angular velocity inverse solution.
优选的,所述线速度逆解算包括:取四个轮组中对角的两个轮组分别为一组,以其中一组中两个轮组的速度矢量和作为机器人底盘的实际线速度。Preferably, the inverse solution of the linear velocity includes: taking two diagonal wheel groups of the four wheel groups as a group, and taking the sum of the velocity vectors of the two wheel groups in one group as the actual linear velocity of the robot chassis.
优选的,所述角速度逆解算包括:通过惯导测量单元采集机器人底盘的角加速度数据,再经过积分运算得到机器人底盘的角速度。Preferably, the inverse solution of the angular velocity includes: collecting angular acceleration data of the robot chassis through an inertial navigation measurement unit, and then obtaining the angular velocity of the robot chassis through an integral operation.
优选的,所述根据四个轮组的实际运动情况调整四个轮组的协同控制过程包括:当前轮组若执行控制指令后将超出轮组的角度限值时,轮组反方向转至其补角,并同时将轮组的速度反向后,再执行控制指令。Preferably, the process of adjusting the coordinated control of the four wheel groups according to the actual movement conditions of the four wheel groups includes: when the current wheel group will exceed the angle limit of the wheel group after executing the control instruction, the wheel group rotates in the opposite direction to its supplementary angle, and at the same time reverses the speed of the wheel group before executing the control instruction.
优选的,所述根据四个轮组的实际运动情况调整四个轮组的协同控制过程包括:当四个轮组的速度中的最大值vmax大于速度限制值vlimit时,将四个轮组的速度同比缩放vlimit/vmax。Preferably, the process of adjusting the coordinated control of the four wheel sets according to the actual movement conditions of the four wheel sets includes: when a maximum value v max among the speeds of the four wheel sets is greater than a speed limit value v limit , scaling the speeds of the four wheel sets by v limit /v max .
优选的,所述根据四个轮组的实际运动情况调整四个轮组的协同控制过程包括:当轮组的转向操作的目标转角值大于设定的转角限制值时,判断采集的轮组的速度是否大于预定阈值v0,若是,则先对轮组进行制动使速度降到阈值v0以下后,再进行转向操作。Preferably, the process of adjusting the coordinated control of the four wheel sets according to the actual movement conditions of the four wheel sets includes: when the target turning angle value of the steering operation of the wheel set is greater than the set turning angle limit value, judging whether the collected speed of the wheel set is greater than a predetermined threshold value v 0 , and if so, braking the wheel set to reduce the speed to below the threshold value v 0 before performing the steering operation.
优选的,所述根据四个轮组的实际运动情况调整四个轮组的协同控制过程包括:当采集到轮组的加速度超过设定的加速度限制值时,产生将轮组的加速度分解成符合加速度限值的控制指令。Preferably, the process of adjusting the coordinated control of the four wheel sets according to the actual movement conditions of the four wheel sets includes: when the collected acceleration of the wheel set exceeds the set acceleration limit value, generating a control instruction to decompose the acceleration of the wheel set into control instructions that meet the acceleration limit value.
优选的,所述机器人底盘包括底盘框架和设置在底盘框架上的控制器和四个轮组,所述轮组包括防护架和设置在防护架中并依次连接的驱动电机、编码器、行星减速器、联轴器和轮子;所述防护架包括水平的上挡板和下挡板,所述上挡板和下挡板的端部分别都与轮子内侧的轴心部分连接,所述行星减速器与联轴器之间设有第一竖板;所述行星减速器对应的上挡板上侧设有转向传动件,所述转向传动件套在位于其上方的转向电机的输出轴上,所述转向电机设置在与底盘框架固定连接的保护壳中;四个轮组的编码器、驱动电机及转向电机分别都与控制器连接。Preferably, the robot chassis includes a chassis frame, a controller and four wheel sets arranged on the chassis frame, the wheel set includes a protective frame and a drive motor, an encoder, a planetary reducer, a coupling and a wheel arranged in the protective frame and connected in sequence; the protective frame includes a horizontal upper baffle and a lower baffle, the ends of the upper baffle and the lower baffle are respectively connected to the axial part on the inner side of the wheel, and a first vertical plate is provided between the planetary reducer and the coupling; a steering transmission member is provided on the upper side of the upper baffle corresponding to the planetary reducer, and the steering transmission member is sleeved on the output shaft of the steering motor located above it, and the steering motor is arranged in a protective shell fixedly connected to the chassis frame; the encoders, drive motors and steering motors of the four wheel sets are respectively connected to the controller.
优选的,所述底盘框架上侧设有激光雷达,所述激光雷达与所述控制器连接。Preferably, a laser radar is provided on the upper side of the chassis frame, and the laser radar is connected to the controller.
与现有技术相比,本发明通过对4WID-4WIS机器人底盘运动学解算得到四个轮组的控制指令,通过对四个轮组实际运动情况的逆解算获得机器人底盘的综合速度和角速度,实现对四个轮组的协同控制,尽可能避免由于控制指令与轮组的不适应而带来的不利影响,确保下达的控制指令符合轮组在受控瞬时的姿态朝向,确保4个轮组收到控制指令可以使车体向期望的控制方向前进,而不会使轮子相互之间出现不一致的速度或相矛盾的角度,进而使车体的运动产生误差,提高机器人控制的准确性。Compared with the prior art, the present invention obtains control instructions for four wheel groups by solving the kinematics of the 4WID-4WIS robot chassis, obtains the comprehensive speed and angular velocity of the robot chassis by inversely solving the actual motion conditions of the four wheel groups, and realizes coordinated control of the four wheel groups, avoiding adverse effects caused by the incompatibility between the control instructions and the wheel groups as much as possible, ensuring that the issued control instructions are consistent with the posture orientation of the wheel groups at the moment of being controlled, and ensuring that the four wheel groups receive the control instructions to make the vehicle body move in the desired control direction without causing inconsistent speeds or contradictory angles between the wheels, thereby causing errors in the movement of the vehicle body, thereby improving the accuracy of robot control.
附图说明BRIEF DESCRIPTION OF THE DRAWINGS
图1为4WID-4WIS机器人底盘自动导引方法流程示意图;FIG1 is a schematic diagram of a 4WID-4WIS robot chassis automatic guidance method flow chart;
图2为实施例中机器人底盘示意图;FIG2 is a schematic diagram of a robot chassis in an embodiment;
图3为实施例中优化前后的路径示意图;FIG3 is a schematic diagram of the path before and after optimization in the embodiment;
图4为实施例中机器人底盘的后视示意图;FIG4 is a rear view schematic diagram of a robot chassis in an embodiment;
图5为实施例中轮组的结构示意图。FIG. 5 is a schematic diagram of the structure of a wheel set in an embodiment.
图中标注:1、底盘框架,2、控制器,3、轮组,4、激光雷达,5、驱动电机,6、编码器,7、第二出线孔,8、行星减速器,9、联轴器,10、轮子,11、上挡板,12、下挡板,13、第一竖板,14、护板,15、转向传动件,16、转向电机,17、支撑板,18、第二竖板,19、上遮板,20、第一出线孔,21、连接板。Markings in the figure: 1. chassis frame, 2. controller, 3. wheel set, 4. laser radar, 5. drive motor, 6. encoder, 7. second wire outlet hole, 8. planetary reducer, 9. coupling, 10. wheel, 11. upper baffle, 12. lower baffle, 13. first vertical plate, 14. guard plate, 15. steering transmission part, 16. steering motor, 17. support plate, 18. second vertical plate, 19. upper shield plate, 20. first wire outlet hole, 21. connecting plate.
具体实施方式DETAILED DESCRIPTION
下面结合附图和具体实施例对本发明进行详细说明。本实施例以本发明技术方案为前提进行实施,给出了详细的实施方式和具体的操作过程,但本发明的保护范围不限于下述的实施例。The present invention is described in detail below in conjunction with the accompanying drawings and specific embodiments. This embodiment is implemented based on the technical solution of the present invention, and provides a detailed implementation method and specific operation process, but the protection scope of the present invention is not limited to the following embodiments.
实施例Example
本申请提出一种4WID-4WIS机器人底盘的自动导引方法,机器人底盘设有四个轮组,选择较为成熟的ROS作为导航体系平台。The present application proposes an automatic guidance method for a 4WID-4WIS robot chassis. The robot chassis is provided with four wheel sets, and the relatively mature ROS is selected as the navigation system platform.
该方法包括:The method includes:
S1、获得机器人当前的位置定位;S1. Get the current position of the robot;
机器人的定位系统通过整合来自于轮组编码器以及探测装置,如激光雷达等的信息,通过现有的蒙特卡洛算法,获得自身的位置定位估计;The robot's positioning system obtains its own position estimation by integrating information from wheel encoders and detection devices such as lidar, etc., using the existing Monte Carlo algorithm;
S2、通过现有的路径查找算法,获得从当前位置到达目标位置的全局路径,从全局路径中划分出当前位置周围的局部区域,并通过现有的模拟计算的方式,获得局部区域的目标点与局部路径,根据局部路径得到接下来一段时间内机器人的运动参数;S2. Obtain a global path from the current position to the target position through an existing path finding algorithm, divide a local area around the current position from the global path, and obtain the target point and local path of the local area through an existing simulation calculation method, and obtain the motion parameters of the robot in the next period of time according to the local path;
S3、根据机器人的运动参数,以机器人底盘中心为原点建立直角坐标系,得到四个轮组各自的运动速度、运动方向和自转角速度的控制指令;S3. According to the motion parameters of the robot, a rectangular coordinate system is established with the center of the robot chassis as the origin to obtain control instructions for the motion speed, motion direction and rotation angular velocity of each of the four wheel groups;
S4、根据控制指令控制机器人运动的过程中,采集四个轮组的实际运动情况,通过运动学逆解算得到机器人底盘的实际运动情况,并根据四个轮组的实际运动情况调整四个轮组的协同控制过程。S4. In the process of controlling the movement of the robot according to the control instructions, the actual movement conditions of the four wheel groups are collected, the actual movement conditions of the robot chassis are obtained through inverse kinematics solution, and the coordinated control process of the four wheel groups is adjusted according to the actual movement conditions of the four wheel groups.
实现四轮系统的运动学解算与逆解算是整个机器人底盘接入控制系统的基础。当启用全向控制时,对于在平面运动的机器人,以垂直轮轴方向为X轴方向,平行轮轴方向为Y轴方向,其获得的指令应当包含三个部分,X轴方向线速度vx,Y轴方向线速度vy和自转角速度ω,三者合成得到机器人沿平面上某一点进行旋转运动。本实施例中,为了简化说明,取车体外一点做旋转点A进行说明,如图2所示。The kinematic solution and inverse solution of the four-wheel system are the basis for the entire robot chassis access control system. When omnidirectional control is enabled, for a robot moving in a plane, the direction perpendicular to the wheel axis is the X-axis direction, and the direction parallel to the wheel axis is the Y-axis direction. The instructions obtained should contain three parts: the linear velocity v x in the X-axis direction, the linear velocity v y in the Y-axis direction, and the rotation angular velocity ω. The three are synthesized to obtain the robot rotating along a certain point on the plane. In this embodiment, in order to simplify the description, a point outside the vehicle body is taken as the rotation point A for description, as shown in Figure 2.
对于车体绕一点A的旋转运动,即车体绕其以确定的半径与线速度进行运动。车体的线速度是由vx与vy共同决定的,vx与vy方向是相互垂直的,根据速度的合成计算,可以得到:For the rotational motion of the vehicle body around point A, that is, the vehicle body moves around it at a certain radius and linear velocity. The linear velocity of the vehicle body is determined by v x and v y . The directions of v x and v y are perpendicular to each other. According to the composite calculation of the velocity, we can get:
而vxy的方向同样由vx与vy获得,对于第一象限的情况,其相对X轴的角度应为:The direction of v xy is also obtained from v x and v y . For the first quadrant, its angle relative to the X axis should be:
α=arctan(vy/vx)α=arctan( vy / vx )
对于不考虑有自转速度的情况,此处计算所得的vxy与α角即是4个轮组共享的旋转角与驱动速度。For the case where the rotation speed is not considered, the v xy and angle α calculated here are the rotation angle and driving speed shared by the four wheel sets.
对于加入了角速度的情况,四轮的运动即相当于直线运动与纯自转运动的合成。由于线速度vxy与角速度ω已知,可知旋转中心A与机器人底盘中心O点的距离即旋转半径,为R=vxy/ω。When angular velocity is added, the motion of the four wheels is equivalent to the synthesis of linear motion and pure rotational motion. Since the linear velocity vxy and the angular velocity ω are known, the distance between the rotation center A and the center point O of the robot chassis, i.e., the rotation radius, is R = vxy /ω.
旋转中心A相对点O的角度位置同样可以由vxy的方向给出,由于R总是与vxy垂直,根据原始速度vx与vy的符号,可以综合确定旋转中心A相对O点的方向为αA=α±π/2,该式的正负号由vx与vy的方向分情况决定。The angular position of the rotation center A relative to point O can also be given by the direction of vxy . Since R is always perpendicular to vxy , according to the signs of the original velocities vx and vy , the direction of the rotation center A relative to point O can be comprehensively determined as αA = α±π/2. The positive and negative sign of this formula is determined by the directions of vx and vy .
由此,本方法以机器人底盘中心为直角坐标系原点(0,0),可以得到旋转中心点A的坐标(RcosαA,RsinαA)。Therefore, this method takes the center of the robot chassis as the origin (0, 0) of the rectangular coordinate system, and can obtain the coordinates of the rotation center point A (Rcosα A , Rsinα A ).
在速度控制计算时,机器人底盘被简化为了没有长宽的质点,但是实际到轮组控制时,轮组的位置必须考虑,如图2所示,可以明显看出4个轮组的旋转角度会受到机器人底盘尺寸的影响而有明显不同。In the speed control calculation, the robot chassis is simplified to a point mass without length and width. However, when it comes to actual wheel control, the position of the wheel must be considered. As shown in Figure 2, it can be clearly seen that the rotation angles of the four wheel groups will be significantly different due to the size of the robot chassis.
假定机器人底盘的长与宽分别为H与D,则在底盘中心O建立的直角坐标系中,其左前轮组坐标为(-D/2,H/2),右前轮组为(D/2,H/2),同理可得左、右后轮组的坐标分别为(-D/2,-H/2),(D/2,-H/2)。Assuming that the length and width of the robot chassis are H and D respectively, then in the rectangular coordinate system established at the center of the chassis O, the coordinates of the left front wheel group are (-D/2, H/2), and the right front wheel group is (D/2, H/2). Similarly, the coordinates of the left and right rear wheel groups are (-D/2, -H/2) and (D/2, -H/2) respectively.
这样在已知旋转中心(RcosαA,RsinαA)与四个轮组坐标后,可得四条由旋转中心A指向四个轮组中心的向量U1、U2、U3、U4,则U1向量具体为(-D/2-RcosαA,H/2-RsinαA),U2向量为(D/2-RcosαA,H/2-RsinαA),U3向量为(-D/2-RcosαA,-H/2-RsinαA),U4向量为(D/2-RcosαA,-H/2-RsinαA)。In this way, after the rotation center (Rcosα A , Rsinα A ) and the coordinates of the four wheel sets are known, four vectors U1, U2, U3, and U4 pointing from the rotation center A to the centers of the four wheel sets can be obtained. The U1 vector is specifically (-D/2-Rcosα A , H/2-Rsinα A ), the U2 vector is (D/2-Rcosα A , H/2-Rsinα A ), the U3 vector is (-D/2-Rcosα A , -H/2-Rsinα A ), and the U4 vector is (D/2-Rcosα A , -H/2-Rsinα A ).
以四个轮组中心的坐标分别为新向量起点,做出4个新向量V1、V2、V3、V4分别垂直于U1、U2、U3、U4,则新向量的方向即为四个轮轴的运动方向,V1为(H/2-RsinαA,D/2+RcosαA),V2为(H/2-RsinαA,-D/2+RcosαA),V3为(-H/2-RsinαA,D/2+RcosαA),V4为(-H/2-RsinαA,-D/2+RcosαA)Take the coordinates of the four wheel group centers as the starting points of the new vectors, and make four new vectors V1, V2, V3, and V4 perpendicular to U1, U2, U3, and U4 respectively. The directions of the new vectors are the movement directions of the four wheel axles. V1 is (H/2-Rsinα A , D/2+Rcosα A ), V2 is (H/2-Rsinα A , -D/2+Rcosα A ), V3 is (-H/2-Rsinα A , D/2+Rcosα A ), and V4 is (-H/2-Rsinα A , -D/2+Rcosα A ).
四个轮轴的速度大小由前述U1~U4向量与角速度ω共同决定,左前轮的速度大小具体为|V1|=|U1|·ω,右前轮为|V2|=|U2|·ω,左后轮为|V3|=|U3|·ω,右后轮为|V4|=|U4|·ω。The speeds of the four wheel axles are determined by the aforementioned U1~U4 vectors and the angular velocity ω. The speed of the left front wheel is |V1|=|U1|·ω, the speed of the right front wheel is |V2|=|U2|·ω, the speed of the left rear wheel is |V3|=|U3|·ω, and the speed of the right rear wheel is |V4|=|U4|·ω.
由此可以获得四个轮轴的运动方向与速度大小,即向量V1、V2、V3、V4的方向与大小,完成了机器人底盘控制的运动学解算,得到步骤S3中四个轮组各自的运动速度、运动方向和自转角速度的控制指令。In this way, the movement direction and speed of the four wheel axles, that is, the direction and size of the vectors V1, V2, V3, and V4, can be obtained, completing the kinematic solution of the robot chassis control, and obtaining the control instructions for the movement speed, movement direction, and rotation angular velocity of each of the four wheel groups in step S3.
然而对于导航系统来说,机器人的反馈数据是自我定位预估的重要输入源,对于机器人来说,其通过安装于四个轮组驱动器上的编码器与角度传感器得到四轮的真实速度与朝向,需要通过算法合成为机器人的综合速度与角速度,反馈给上层系统。这一过程称为车体的运动学逆解算。步骤S4中运动学逆解算包括线速度逆解算和角速度逆解算。However, for the navigation system, the robot's feedback data is an important input source for self-positioning estimation. For the robot, the encoders and angle sensors installed on the four wheel drives obtain the real speed and direction of the four wheels, which need to be synthesized into the robot's comprehensive speed and angular velocity through an algorithm and fed back to the upper system. This process is called the inverse kinematic solution of the vehicle body. The inverse kinematic solution in step S4 includes the inverse linear velocity solution and the inverse angular velocity solution.
与传统车型相比,四轮独立驱动系统相比传统控制体系的逆解算复杂的多,以传统二轮差速结构为例,其输入为二轮的速度,且二轮的位置与朝向恒定,其叠加效果可以直接进行两速度大小的综合计算,获得车体车轴及延长线上的一点为旋转中心,以此进行车体的速度与角速度计算,整个过程有唯一解。Compared with traditional models, the four-wheel independent drive system has a much more complicated inverse solution than the traditional control system. Taking the traditional two-wheel differential structure as an example, its input is the speed of the two wheels, and the position and direction of the two wheels are constant. The superposition effect can directly perform a comprehensive calculation of the two speeds, and obtain a point on the axle and extension line of the vehicle body as the center of rotation, so as to calculate the speed and angular velocity of the vehicle body. The whole process has a unique solution.
而对于4WID-4WIS来说,由于真实世界中的控制必然存在误差,也就意味着四轮主动控制的过程中,轮组一定会发生微小滑移,当采样速度足够快时,采样数据较小,引入的误差不可忽略。As for 4WID-4WIS, since there are bound to be errors in real-world control, it means that during the four-wheel active control process, the wheels will inevitably slip slightly. When the sampling speed is fast enough, the sampling data is small and the introduced error cannot be ignored.
对于四轮系统,其4个轮组两两一对,共有4x3/2=6种组合,这六种组合每一种都可以唯一确定一组共同速度与角速度。这就为运动逆解算造成了困难。由于实际情况瞬息万变,难以用相对稳定的方式完成数据的融合。For a four-wheel system, the four wheels are paired in pairs, with a total of 4x3/2=6 combinations. Each of these six combinations can uniquely determine a set of common speeds and angular velocities. This makes it difficult to solve the inverse motion. As the actual situation changes rapidly, it is difficult to complete data fusion in a relatively stable way.
根据三角形稳定原理,当四轮车体由于地形、重心等变化发生单轮失效时,与其相邻的,以及位于对角线上的轮组应当处于与地面接触状态,因此,本方法只取对角的轮组对,即左前与右后、右前与左后的轮组作为采样对,将其结果的平均值作为机器人底盘的预估线速度。线速度逆解算包括:According to the triangle stability principle, when a single wheel of a four-wheel vehicle fails due to changes in terrain, center of gravity, etc., the adjacent wheels and the wheels on the diagonal should be in contact with the ground. Therefore, this method only takes the diagonal wheel pairs, i.e. the left front and right rear, right front and left rear wheels as sampling pairs, and takes the average of the results as the estimated linear velocity of the robot chassis. The inverse solution of the linear velocity includes:
对其中的某一对轮组,在已知两轮速度v1、v2与转向角d1、d2的情况下,其线速度由矢量合成获得,可得其X轴和Y轴方向预估线速度分别为:For one of the wheel pairs, when the two wheel speeds v 1 , v 2 and the steering angles d 1 , d 2 are known, its linear velocity is obtained by vector synthesis, and its estimated linear velocity in the X-axis and Y-axis directions can be obtained respectively:
evx=cosd1·v1+cosd2·v2 ev x =cosd 1 ·v 1 +cosd 2 ·v 2
evy=sind1·v1+sind2·v2 ev y =sind 1 ·v 1 +sind 2 ·v 2
根据实验结果,运动学逆解算获得的线速度基本在可接受的误差范围,而转角速度由于采样值较小,引入的误差为这一自由度的计算造成了严重困难。本方法决定使用外部增加传感器——惯性测量单元完成角速度的收集,而使用位于轮组上电机输出轴处的编码器完成线速度的采集。惯导传感器,也叫惯性测量单元(IMU),其基本结构包括三轴加速度计与三轴角加速度计,即陀螺仪。有些惯导系统,通过地磁传感器可以获得朝向角的绝对方向,但是考虑机器人底盘中驱动电路电流对微弱地磁场的影响,以及周围应用环境的不确定性,地磁传感器并不是一个可靠的方案,因此本方法使用加速度计与角加速度计进行姿态解算。According to the experimental results, the linear velocity obtained by the inverse kinematic solution is basically within the acceptable error range, while the error introduced by the angular velocity due to the small sampling value has caused serious difficulties in the calculation of this degree of freedom. This method decides to use an external sensor, the inertial measurement unit, to complete the collection of angular velocity, and use an encoder located at the motor output shaft on the wheel set to complete the collection of linear velocity. The inertial navigation sensor, also known as the inertial measurement unit (IMU), has a basic structure consisting of a three-axis accelerometer and a three-axis angular accelerometer, i.e., a gyroscope. Some inertial navigation systems can obtain the absolute direction of the heading angle through a geomagnetic sensor, but considering the influence of the driving circuit current in the robot chassis on the weak geomagnetic field and the uncertainty of the surrounding application environment, the geomagnetic sensor is not a reliable solution. Therefore, this method uses an accelerometer and an angular accelerometer for attitude solution.
轮组的角速度由惯导测量单元得出。角速度逆解算包括:通过陀螺仪来说采集的角加速度数据,经过积分运算即可获得角速度数值。The angular velocity of the wheel set is obtained by the inertial measurement unit. The inverse solution of the angular velocity includes: the angular acceleration data collected by the gyroscope can be integrated to obtain the angular velocity value.
但是由于采集装置本身的噪声及运动状态的不确定性,对数据不做任何处理就输入系统必然会引入巨大的误差,因此,综合加速度与陀螺仪的数据,进行滤波与混合处理可以很大程度改善误差情况。However, due to the noise of the acquisition device itself and the uncertainty of the motion state, inputting the data into the system without any processing will inevitably introduce huge errors. Therefore, comprehensive acceleration and gyroscope data, filtering and mixing can greatly improve the error situation.
对原始数据进行卡尔曼滤波可以对数据做线性优化,很大程度上可以消除系统电路引入的噪声;通过采集一段时间的静止状态下的数据,可以获得系统的初始误差,进而进行消除,通过对滤波后的数据进行处理,获得当前车头朝向及瞬时车体自转速度的数据。Kalman filtering of the raw data can perform linear optimization on the data and eliminate the noise introduced by the system circuit to a large extent. By collecting data in a static state for a period of time, the initial error of the system can be obtained and then eliminated. By processing the filtered data, the current vehicle head direction and instantaneous vehicle rotation speed data can be obtained.
经过多次实验,基于惯导测量单元的预估角速度获得了很好的应用效果,由于惯导测量单元不可避免的产生数据漂移,这是作为相对量传感器无法消除的累积误差,应此在航向角的读取上,通过综合轮组的运动情况,只在机器人运动时读入预估航向角的差值进行使用,可以避免长时间静置后的航向误差累计。After many experiments, the estimated angular velocity based on the inertial measurement unit has achieved good application results. Since the inertial measurement unit inevitably produces data drift, this is a cumulative error that cannot be eliminated as a relative quantity sensor. Therefore, when reading the heading angle, the movement of the comprehensive wheel group is used to read the difference in the estimated heading angle only when the robot is moving, which can avoid the accumulation of heading errors after long-term static state.
对于4WID-4WIS机器人来说,最大的控制难度在于轮组的协同控制。在这一方面,本方法进行了多方位的优化。在控制驱动程序中,对运动解算后的结果进行实时跟踪与后处理,根据四个轮组的实际运动情况调整四个轮组的协同控制主要集中在以下几点:For the 4WID-4WIS robot, the biggest control difficulty lies in the coordinated control of the wheel groups. In this regard, this method has been optimized in many aspects. In the control driver, the results of the motion solution are tracked and post-processed in real time. The coordinated control of the four wheel groups is adjusted according to the actual motion conditions of the four wheel groups, mainly focusing on the following points:
1、限幅:由于4WIS系统的转向结构并不能实现连续的360度旋转,应此需要对算法获得的角度进行判断,当前轮组若执行控制指令后将超出轮组的角度限值时,轮组反方向转至其补角,并同时将轮组的速度反向后,再执行控制指令。1. Limitation: Since the steering structure of the 4WIS system cannot achieve continuous 360-degree rotation, it is necessary to judge the angle obtained by the algorithm. If the current wheel set will exceed the angle limit of the wheel set after executing the control command, the wheel set will rotate in the opposite direction to its supplementary angle, and at the same time reverse the speed of the wheel set before executing the control command.
2、转换:由于内外轮差的效应影响,每处轮组速度不同,外部轮组可能规划出超过其执行能力的速度值,此时就需要对所有轮子的速度做出采样,获得4个独立轮组速度中的最大值vmax,将这一速度与速度限制值vlimit一同参与计算,对于vmax>vlimit的情况,需要将4个轮组的速度同比缩放vlimit/vmax倍,以保证其正常工作。2. Conversion: Due to the effect of the inner and outer wheel difference, the speed of each wheel group is different. The outer wheel group may plan a speed value that exceeds its execution capability. At this time, it is necessary to sample the speeds of all wheels to obtain the maximum value v max of the four independent wheel group speeds. This speed is calculated together with the speed limit value v limit . For the case of v max >v limit , the speeds of the four wheel groups need to be scaled by v limit /v max to ensure their normal operation.
3、状态判定:对4个轮组的目标转角值进行监控,当轮组的转向操作的目标转角值大于设定的转角限制值,如30°时,此时应综合轮组的速度进行判断,判断采集的轮组的速度是否大于预定阈值v0,若是,则转向的控制指令先往后排,要求轮组首先进行制动,当速度降到阈值v0以下后,再进行转向与后续操作,以此避免高速下忽然变相造成的严重滑移。3. Status judgment: Monitor the target steering angle values of the four wheel sets. When the target steering angle value of the wheel set steering operation is greater than the set steering angle limit value, such as 30°, the wheel set speed should be comprehensively considered to determine whether the collected wheel set speed is greater than the preset threshold value v 0. If so, the steering control command is first placed backwards, requiring the wheel set to brake first. When the speed drops below the threshold value v 0 , steering and subsequent operations are performed to avoid severe slippage caused by sudden changes in speed at high speed.
4、对速度的变化速度进行限制,即加速度限制:对于超过限制的速度变化量,产生将轮组的加速度分解成符合加速度限值的控制指令,避免车体由于无法响应造成的滑移误差。4. Limit the speed of change, that is, acceleration limit: For speed changes exceeding the limit, generate control instructions to decompose the acceleration of the wheel set into control instructions that meet the acceleration limit to avoid slip errors caused by the vehicle body's inability to respond.
在指令规划器中尽可能调整了规划的参数,优化的参数主要包括路线计算时,给定的速度上下限制,加速度上下限值,各惩罚条件累加时的加权值等。规划的过程其实是构造目标函数,将各种限制值参数乘上权重以后进行综合计算,查找目标函数的极限值。目标函数的组成部分为各受考虑条件的惩罚值,包括距离目标点的直线距离,距离路径上各处障碍物(包括墙壁)的距离的累加,车体在一段路线上的非线性等,当车体距离目标越远,与障碍物的距离越近,路线非线性度越高,则惩罚得分越大,目标函数最小值对应的路线即是最优路线。通过调节其对航向调节行为的惩罚值,一定程度的调整其对障碍物的响应距离与响应程度,使最终的规划路线倾向于平滑的直线与大角度曲线,进而尽可能避免由于命令与车体的不适应而带来的不利影响,如图3所示。The planning parameters are adjusted as much as possible in the command planner. The optimized parameters mainly include the given speed upper and lower limits, acceleration upper and lower limits, and weighted values when each penalty condition is accumulated during route calculation. The planning process is actually to construct the objective function, multiply the various limit value parameters by the weights, and then perform comprehensive calculations to find the limit value of the objective function. The components of the objective function are the penalty values of each considered condition, including the straight-line distance from the target point, the accumulation of the distance from each obstacle on the path (including the wall), the nonlinearity of the vehicle body on a section of the route, etc. The farther the vehicle body is from the target, the closer the distance to the obstacle, and the higher the nonlinearity of the route, the greater the penalty score, and the route corresponding to the minimum value of the objective function is the optimal route. By adjusting the penalty value of the heading adjustment behavior, the response distance and response degree to the obstacle are adjusted to a certain extent, so that the final planned route tends to be a smooth straight line and a large-angle curve, thereby avoiding the adverse effects caused by the incompatibility between the command and the vehicle body as much as possible, as shown in Figure 3.
ROS仍然是一个更多面向学习与研究的平台,为了使其可以简单的与外部设备沟通以及稳定可靠的工作,机器人建立了完善的外部通讯接口,将系统封闭成相对独立的一个部分,这样在对接上部命令与其他设备时,无需再直接访问这一系统,提高了系统的稳定性与安全性。ROS is still a platform that is more oriented towards learning and research. In order to enable it to communicate easily with external devices and work stably and reliably, the robot has established a complete external communication interface, closing the system into a relatively independent part. In this way, when connecting upper commands with other devices, there is no need to directly access this system, which improves the stability and security of the system.
机器人的外部通讯使用串口通讯实现,通过定义一套指令应答表,以一问一答的方式工作,导航系统主机作为通讯中的从机方,接收指令并反馈状态。The robot's external communication is implemented using serial port communication. By defining a set of command response tables, it works in a question-and-answer manner. The navigation system host acts as the slave in the communication, receiving commands and providing feedback on the status.
指令主要包括命令类与查询类,通过命令可以快速切换预先存放好的地图,设定自身的预估位置或是导航的目标位置。而查询命令则可以获得机器人的实时位置、方向角、电量、工作状态等各种信息。通过与上位设备的合作,机器人底盘系以完成自动化工作、自动充电,甚至乘坐电梯穿梭不同的楼层,通过加载不同地图的方式,完成原生ROS导航框架下难以完成的任务。Instructions mainly include command and query. Through commands, you can quickly switch pre-stored maps, set your own estimated position or navigation target position. The query command can obtain various information such as the robot's real-time position, direction, power, working status, etc. By cooperating with the upper device, the robot chassis can complete automated work, automatic charging, and even take the elevator to travel between different floors. By loading different maps, it can complete tasks that are difficult to complete under the native ROS navigation framework.
本实施例中机器人底盘结构如图4所示,包括底盘框架1和设置在底盘框架1上的控制器2、激光雷达4和四个轮组3。激光雷达4与控制器2连接,具体采用Hokuyo的UST-10LX型号。本实施例中,控制器2具体为计算机。The robot chassis structure in this embodiment is shown in FIG4 , including a chassis frame 1 and a controller 2, a laser radar 4 and four wheel sets 3 arranged on the chassis frame 1. The laser radar 4 is connected to the controller 2, and specifically adopts the UST-10LX model of Hokuyo. In this embodiment, the controller 2 is specifically a computer.
如图5所示,轮组3包括防护架和设置在防护架中并依次连接的驱动电机5、编码器6、行星减速器8、联轴器9和轮子10。防护架包括水平的上挡板11和下挡板12,上挡板11和下挡板12的端部分别都与轮子10内侧的轴心部分连接,行星减速器8与联轴器9之间设有第一竖板13,增加支撑能力。As shown in Fig. 5, the wheel set 3 includes a protection frame and a driving motor 5, an encoder 6, a planetary reducer 8, a coupling 9 and a wheel 10 which are arranged in the protection frame and connected in sequence. The protection frame includes a horizontal upper baffle 11 and a lower baffle 12, and the ends of the upper baffle 11 and the lower baffle 12 are respectively connected to the inner axial part of the wheel 10. A first vertical plate 13 is provided between the planetary reducer 8 and the coupling 9 to increase the supporting capacity.
行星减速器8对应的上挡板11上侧设有转向传动件15,转向传动件15套在位于其上方的转向电机16的输出轴上。转向电机16设置在与底盘框架1固定连接的保护壳中,保护壳通过连接板21与底盘框架1侧面的底部连接。本实施例中,转向传动件15具体为固定在上挡板11上侧的转轴。四个轮组3的编码器6、驱动电机5及转向电机16分别都与控制器2连接。A steering transmission member 15 is provided on the upper side of the upper baffle 11 corresponding to the planetary reducer 8, and the steering transmission member 15 is sleeved on the output shaft of the steering motor 16 located above it. The steering motor 16 is arranged in a protective shell fixedly connected to the chassis frame 1, and the protective shell is connected to the bottom of the side of the chassis frame 1 through a connecting plate 21. In this embodiment, the steering transmission member 15 is specifically a rotating shaft fixed on the upper side of the upper baffle 11. The encoders 6, the drive motors 5 and the steering motors 16 of the four wheel sets 3 are respectively connected to the controller 2.
行星减速器8对应的下挡板12下侧转动连接有水平设置的支撑板17。支撑板17向驱动电机5所在方向延伸,并通过第二竖板18连接位于防护架上方的上遮板19,上遮板19的端部可活动的套在转向传动件15的外侧。The lower side of the lower baffle plate 12 corresponding to the planetary reducer 8 is rotatably connected to a horizontally arranged support plate 17. The support plate 17 extends in the direction of the drive motor 5 and is connected to an upper shield plate 19 located above the protective frame through a second vertical plate 18. The end of the upper shield plate 19 can be movably sleeved on the outer side of the steering transmission member 15.
第二竖板18与底盘框架1固定连接,并且设有第一出线孔20,下挡板12上设有第二出线孔7,有利于数据线的布线。The second vertical plate 18 is fixedly connected to the chassis frame 1 and is provided with a first wire outlet hole 20 . The lower baffle plate 12 is provided with a second wire outlet hole 7 , which is beneficial to the wiring of the data line.
轮子10的顶部的上方设有护板14,护板14的两侧分别与轮子10内侧的上挡板11和轮子10外侧的轴心部分连接,护板14可以减少轮子10受环境的影响。A guard plate 14 is provided above the top of the wheel 10 , and two sides of the guard plate 14 are respectively connected to the upper baffle 11 on the inner side of the wheel 10 and the axial part on the outer side of the wheel 10 . The guard plate 14 can reduce the impact of the environment on the wheel 10 .
Claims (6)
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910100209.8A CN111506054B (en) | 2019-01-31 | 2019-01-31 | Automatic guiding method of 4WID-4WIS robot chassis |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910100209.8A CN111506054B (en) | 2019-01-31 | 2019-01-31 | Automatic guiding method of 4WID-4WIS robot chassis |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111506054A CN111506054A (en) | 2020-08-07 |
CN111506054B true CN111506054B (en) | 2024-11-01 |
Family
ID=71863782
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910100209.8A Active CN111506054B (en) | 2019-01-31 | 2019-01-31 | Automatic guiding method of 4WID-4WIS robot chassis |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111506054B (en) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112319236B (en) * | 2020-10-26 | 2022-04-22 | 广州视源电子科技股份有限公司 | Motion control method of mobile robot chassis and mobile robot chassis |
CN112256036B (en) * | 2020-11-03 | 2024-02-06 | 浙江国自机器人技术股份有限公司 | Chassis operation control method, system and device and AGV trolley |
CN114608607A (en) * | 2022-03-17 | 2022-06-10 | 山东新一代信息产业技术研究院有限公司 | Chassis mileometer synthesis method and system of four-wheel eight-drive robot |
CN116185004A (en) * | 2022-12-14 | 2023-05-30 | 浙江国自机器人技术股份有限公司 | Wheeled robot control method, calibration device and wheeled robot |
CN115877849B (en) * | 2022-12-29 | 2025-03-28 | 江苏金陵智造研究院有限公司 | A multi-differential wheel coordinated control method |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107045342A (en) * | 2016-12-20 | 2017-08-15 | 西南科技大学 | A kind of autonomous guidance system of interactive mode based on three-wheel Omni-mobile and method |
WO2018216530A1 (en) * | 2017-05-26 | 2018-11-29 | 学校法人東京理科大学 | Omnidirectional moving device and method for controlling attitude thereof |
CN209606847U (en) * | 2019-01-31 | 2019-11-08 | 上海制驰智能科技有限公司 | A kind of 4WID-4WIS robot chassis |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2615084B2 (en) * | 1987-10-24 | 1997-05-28 | 富士重工業株式会社 | Torque split control device for four-wheel drive vehicle |
JP3555132B2 (en) * | 2000-02-18 | 2004-08-18 | 日産自動車株式会社 | Driving force distribution control device for four-wheel drive vehicle |
JP5641872B2 (en) * | 2010-10-26 | 2014-12-17 | 株式会社ユニバンス | Driving force distribution device for four-wheel drive vehicles |
CN104216406B (en) * | 2013-06-05 | 2017-07-14 | 中国石油天然气集团公司 | The control device and control method on a kind of four-wheel drive omnidirectional chassis |
CN104554255A (en) * | 2013-10-22 | 2015-04-29 | 沈阳工业大学 | Dynamic decoupling method for active safety integrated control system of four-wheel drive electric automobile chassis |
-
2019
- 2019-01-31 CN CN201910100209.8A patent/CN111506054B/en active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107045342A (en) * | 2016-12-20 | 2017-08-15 | 西南科技大学 | A kind of autonomous guidance system of interactive mode based on three-wheel Omni-mobile and method |
WO2018216530A1 (en) * | 2017-05-26 | 2018-11-29 | 学校法人東京理科大学 | Omnidirectional moving device and method for controlling attitude thereof |
CN209606847U (en) * | 2019-01-31 | 2019-11-08 | 上海制驰智能科技有限公司 | A kind of 4WID-4WIS robot chassis |
Non-Patent Citations (1)
Title |
---|
动力学与瞬时转向中心求解下的4WIS车辆的转向控制方法;来鑫,等;机械科学与技术;20161130;第35卷(第11期);1761-1767 * |
Also Published As
Publication number | Publication date |
---|---|
CN111506054A (en) | 2020-08-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111506054B (en) | Automatic guiding method of 4WID-4WIS robot chassis | |
CN109917786A (en) | A robot perception system and system operation method for complex environment operations | |
JP5398488B2 (en) | Autonomous mobile object and its control method | |
KR101374616B1 (en) | Autonomous mobile body and control method of same | |
Shimchik et al. | Golf cart prototype development and navigation simulation using ROS and Gazebo | |
CN111679667B (en) | Path and vehicle speed collaborative planning method for unmanned racing vehicle | |
Graettinger et al. | Evaluation and time-scaling of trajectories for wheeled mobile robots | |
Chen et al. | Design and motion control of a spherical robot with control moment gyroscope | |
CN209606847U (en) | A kind of 4WID-4WIS robot chassis | |
Wu et al. | Research on the design of educational robot with four-wheel omni-direction chassis | |
CN108646759A (en) | Intelligent dismountable moving robot system based on stereoscopic vision and control method | |
Tan et al. | Research on omnidirectional indoor mobile robot system based on multi-sensor fusion | |
Bräunl | Driving robots | |
CN116968808A (en) | A cross-symmetrical four-wheel independent drive steering robot control method and robot | |
Vikhe et al. | Four Legged Parallel Manipulator for Autonomous Delivery Robot | |
Ferreira | Hybrid robot with leg & wheel locomotion | |
Duan et al. | Experimental Research on Outdoor Sweeping Robot | |
Selvaraj et al. | Kinematic models of mobile robots: Types and simulation | |
US20250028319A1 (en) | Systems and methods for autonomous vehicle path planning | |
Ruan et al. | B-2WMR system model and underactuated property analysis | |
Lu | Modeling and control for vision based rear wheel drive robot and solving indoor SLAM problem using LIDAR | |
Shi et al. | Research on control method and evaluation system of unmanned ground vehicle group change | |
WO2022075082A1 (en) | Autonomous mobile device, control method and program | |
CN119512126A (en) | Local path planning method for fixed-attitude omnidirectional mobile robot based on improved DWA algorithm | |
Singh et al. | Localization of the Closed-Loop Differential Drive Mobile Robot Using Wheel Odometry |
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 |