An automatic guidance method for 4WID-4WIS robot chassis

By calculating and adjusting the motion parameters and coordinated control of the four wheel sets in the 4WID-4WIS robot chassis, the coordinated control problem is solved, and a more accurate and stable robot motion is achieved.

CN111506054BActive Publication Date: 2024-11-01SHANGHAI ZHICHI INTELLIGENT TECH CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN201910100209.8
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2019-01-31
Publication Date
2024-11-01
Estimated Expiration
2039-01-31

AI Technical Summary

Technical Problem

The collaborative control of 4WID-4WIS robot chassis is difficult to implement a real-time command system, especially in the collaborative control of steering and driving motors, which leads to inaccurate control and errors. The existing technology is difficult to effectively solve this problem.

Method used

By obtaining the current position and target position of the robot, dividing local paths, establishing a rectangular coordinate system, calculating the control instructions for the movement speed, direction and rotation angular velocity of the four wheel groups, and adjusting the coordinated control process through kinematic inverse solution, including linear velocity Inverse solution of angular velocity, optimize the coordinated control of the wheel set to avoid the problem of inconsistent angle and speed.

Benefits of technology

The accurate motion control of the 4WID-4WIS robot chassis is realized, which reduces the error caused by the inadequacy of control instructions and wheel sets, improves the accuracy and stability of robot control, and ensures that the vehicle body moves in the expected direction.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN111506054B_ABST
    Figure CN111506054B_ABST
Patent Text Reader

Abstract

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 of the local area, and obtaining the motion parameters of the robot in the next period of time according to the local path; 3. according to the motion parameters of the robot, a rectangular coordinate system is established with the center of the robot chassis as the origin, and the control instructions of each of the four wheel groups are obtained; 4. the actual motion of the robot chassis is obtained by inverse kinematics solution, and the coordinated control process of the four wheel groups is adjusted 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 and the wheel groups as much as possible, and improves the accuracy of robot control.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] 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

[0002] 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.

[0003] 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.

[0004] 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.

[0005] 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.

[0006] 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

[0007] 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.

[0008] The purpose of the present invention can be achieved by the following technical solutions:

[0009] An automatic guidance method for a 4WID-4WIS robot chassis, wherein the robot chassis is provided with four wheel sets, the method comprising:

[0010] S1. Get the current position of the robot;

[0011] 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;

[0012] 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;

[0013] 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.

[0014] Preferably, the kinematic inverse solution includes linear velocity inverse solution and angular velocity inverse solution.

[0015] 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.

[0016] Preferably, the inverse calculation 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.

[0017] 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.

[0018] Preferably, the process of adjusting the coordinated control of the four wheel sets according to the actual motion conditions of the four wheel sets includes: when the maximum value v among the speeds of the four wheel sets max Greater than the speed limit v limit When the speed of the four wheel groups is scaled by v limit / v max .

[0019] 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 target turning angle value of the steering operation of the wheel group is greater than the set turning angle limit value, judging whether the collected speed of the wheel group is greater than a predetermined threshold value v0; if so, braking the wheel group to reduce the speed to below the threshold value v0 before performing the steering operation.

[0020] 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.

[0021] 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.

[0022] Preferably, a laser radar is provided on the upper side of the chassis frame, and the laser radar is connected to the controller.

[0023] 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

[0024] Figure 1 It is a flow chart of the automatic guidance method of the 4WID-4WIS robot chassis;

[0025] Figure 2 This is a schematic diagram of the robot chassis in the embodiment;

[0026] Figure 3 Schematic diagram of the path before and after optimization in the embodiment;

[0027] Figure 4 A schematic rear view of a robot chassis in an embodiment;

[0028] Figure 5 Schematic diagram of the structure of the wheel set in the embodiment.

[0029] 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

[0030] 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.

[0031] Example

[0032] 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.

[0033] The method includes:

[0034] S1. Get the current position of the robot;

[0035] 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;

[0036] 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;

[0037] 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;

[0038] 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.

[0039] The kinematics 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 vertical wheel axis direction is the X-axis direction, and the parallel wheel axis direction is the Y-axis direction. The command it obtains should contain three parts: the linear velocity v in the X-axis direction x , linear velocity v in the Y-axis direction y The three are combined to obtain the robot's rotational motion 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 illustration, such as Figure 2 shown.

[0040] For the rotational motion of the vehicle body around point A, the vehicle body moves around it at a certain radius and linear velocity. The linear velocity of the vehicle body is given by v x With v y Jointly determined, x With v y The directions are perpendicular to each other. According to the composite calculation of the velocities, we can get:

[0041]

[0042] And v xy The direction of v is also determined by x With v y For the first quadrant, the angle relative to the X-axis should be:

[0043] α=arctan(v y / v x )

[0044] For the case where the rotation speed is not considered, the v calculated here is xy The angle α is the rotation angle and drive speed shared by the four wheel sets.

[0045] When angular velocity is added, the motion of the four wheels is equivalent to the synthesis of linear motion and pure rotational motion. xy With the angular velocity ω known, we know that the distance between the rotation center A and the center of the robot chassis, point O, is the rotation radius, which is R = v xy / ω.

[0046] The angular position of the rotation center A relative to point O can also be expressed by v xy The direction of R is given by v xy vertically, according to the original velocity vx With v y The sign of the rotation center A can be comprehensively determined to be α relative to point O. A =α±π / 2, the sign of this formula is determined by v x With v y The direction depends on the situation.

[0047] Therefore, this method takes the center of the robot chassis as the origin of the rectangular coordinate system (0, 0), and the coordinates of the rotation center point A (Rcosα A , Rsinα A ).

[0048] In speed control calculation, the robot chassis is simplified to a point mass without length and width. However, when it comes to wheel control, the position of the wheel must be considered, such as Figure 2 As shown, it can be clearly seen that the rotation angles of the four wheel sets will be significantly different due to the influence of the robot chassis size.

[0049] 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.

[0050] So at a known rotation center (Rcosα A , Rsinα A ) and the four wheel group coordinates, we can get four vectors U1, U2, U3, and U4 pointing from the rotation center A to the four wheel group centers. The specific U1 vector is (-D / 2-Rcosα A , H / 2-Rsinα A ), U2 vector is (D / 2-Rcosα A , H / 2-Rsinα A ), U3 vector is (-D / 2-Rcosα A , -H / 2-Rsinα A ), U4 vector is (D / 2-Rcosα A , -H / 2-Rsinα A ).

[0051] Take the coordinates of the four wheel center as the starting point of the new vector, and make four new vectors V1, V2, V3, and V4 perpendicular to U1, U2, U3, and U4 respectively. Then the direction of the new vector is the direction of movement of the four wheel axles, and 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 ), V4 is (-H / 2-Rsinα A , -D / 2+Rcosα A )

[0052] 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|·ω.

[0053] 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.

[0054] 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.

[0055] 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.

[0056] 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.

[0057] 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.

[0058] 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:

[0059] For one of the wheel pairs, when the two wheel speeds v1, v2 and the steering angles d1, d2 are known, its linear velocity is obtained by vector synthesis, and the estimated linear velocities in the X-axis and Y-axis directions are:

[0060] ev x =cosd1·v1+cosd2·v2

[0061] ev y =sind1·v1+sind2·v2

[0062] 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.

[0063] 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.

[0064] 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.

[0065] 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.

[0066] 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.

[0067] 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:

[0068] 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.

[0069] 2. Conversion: Due to the effect of the inner and outer wheel difference, the speed of each wheel set is different. The outer wheel set may plan a speed value that exceeds its execution capacity. At this time, it is necessary to sample the speed of all wheels to obtain the maximum value v among the four independent wheel set speeds. max , and compare this speed with the speed limit value v limit Participate in the calculation together, for v max >v limit In this case, the speeds of the four wheels need to be scaled by v limit / v max times to ensure its normal operation.

[0070] 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 judged to determine whether the collected wheel set speed is greater than the preset threshold value v0. 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 v0, steering and subsequent operations are performed to avoid serious slippage caused by sudden changes in speed at high speed.

[0071] 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.

[0072] The planning parameters are adjusted as much as possible in the command planner. The optimized parameters mainly include the given upper and lower speed limits, upper and lower acceleration limits, and weighted values ​​when each penalty condition is accumulated during route calculation. The planning process is actually to construct an objective function, multiply the various limit value parameters by the weights, and then perform a comprehensive calculation 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 distances from various obstacles on the path (including walls), 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 for the heading adjustment behavior, the response distance and response degree to obstacles are adjusted to a certain extent, so that the final planned route tends to be smooth straight lines and large-angle curves, thereby avoiding the adverse effects caused by the incompatibility between the command and the vehicle body as much as possible, such as Figure 3 shown.

[0073] 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.

[0074] 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.

[0075] 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.

[0076] In this embodiment, the robot chassis structure is as follows Figure 4 As shown, it includes 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.

[0077] like Figure 5As shown, 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.

[0078] 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.

[0079] 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.

[0080] 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.

[0081] 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

1. An automatic guidance method for a 4WID-4WIS robot chassis, wherein the robot chassis is provided with four wheel sets, characterized in that: The method includes: S1. Get the current position of the robot; 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. 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, 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 by 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; The process of adjusting the coordinated control of the four wheel sets according to the actual movement conditions of the four wheel sets includes: If the current wheel set will exceed the wheel set angle limit 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 again; When the maximum value of the speeds of the four wheel groups v max Greater than the speed limit v limit When the speed of the four wheels is scaled by v limit / v max ; When the target turning angle value of the steering operation of the wheel set is greater than the set turning angle limit value, it is determined whether the collected wheel set speed is greater than the predetermined threshold value v0. If so, the wheel set is braked to reduce the speed to below the threshold value v0 before the steering operation is performed; When the collected acceleration of the wheel set exceeds the set acceleration limit value, a control instruction is generated to decompose the acceleration of the wheel set into a control instruction that meets the acceleration limit value.

2. The automatic guidance method of a 4WID-4WIS robot chassis according to claim 1, characterized in that: The kinematic inverse solution includes linear velocity inverse solution and angular velocity inverse solution.

3. The automatic guidance method of a 4WID-4WIS robot chassis according to claim 2, characterized in that: The linear velocity inverse solution includes: taking two diagonal wheel groups of the four wheel groups as a group, and taking the velocity vector sum of the two wheel groups in one group as the actual linear velocity of the robot chassis.

4. The automatic guidance method of a 4WID-4WIS robot chassis according to claim 2, characterized in that: The angular velocity inverse solution 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.

5. The automatic guidance method of a 4WID-4WIS robot chassis according to claim 1, characterized in that: The robot chassis includes a chassis frame, a controller and four wheel groups arranged on the chassis frame, and the wheel group 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, and 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 groups are respectively connected to the controller.

6. The automatic guidance method of a 4WID-4WIS robot chassis according to claim 5, characterized in that: A laser radar is provided on the upper side of the chassis frame, and the laser radar is connected to the controller.