A method for obtaining multi-motion modal underlying odometer

Through the acquisition method of the underlying odometer of multi-motion mode, the motion control method and odometer calculation method are automatically identified and converted, and the problem of irregular odometer error in a single mode is solved, and the positioning accuracy of the robot under different motion states is improved. Terrain adaptability.

CN115014385BActive Publication Date: 2024-11-22NAT UNIV OF DEFENSE TECH
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210634413.X
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-06-07
Publication Date
2024-11-22
Estimated Expiration
2042-06-07

AI Technical Summary

Technical Problem

The single motion control mode of existing sports robots leads to irregular odometer positioning errors and is unable to adapt to different motion states. The McNum wheel structure is complex and has poor load-bearing capacity, making it difficult to walk on uneven grounds.

Method used

The multi-motion mode underlying odometer acquisition method is adopted. By detecting the speed and angular velocity of the four wheels, the motion control method is automatically identified and the corresponding odometer calculation method is converted, and different calculation methods are used for different motion states to improve the odometer accuracy.

Benefits of technology

It effectively improves the accuracy of the odometer, reduces wheel side slip errors, adapts to different terrain and motion states, and improves the positioning accuracy of the robot without using external forces.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN115014385B_ABST
    Figure CN115014385B_ABST
Patent Text Reader

Abstract

A method for obtaining a multi-motion modal underlying odometer includes: step S1: obtaining the current speed of four wheels; step S2: calculating the variance of the four wheels to determine whether there is an angular velocity at present; step S3: when the variance is less than 1, it is considered that the four wheels are parallel and have no angular velocity; the velocity component of each wheel speed to the vehicle body coordinate system is calculated, the average speed of the four wheels in the x direction is calculated, the moving distance of the car in the x direction and the distance in the y direction per unit time are obtained, and the distance is assigned to the odometer for solution, and finally the result is provided to a mapping and positioning algorithm; step S4: when the variance is greater than 1, the four wheels are not parallel and there is an angular velocity, the x direction speed, the y direction speed, the x direction moving distance per unit time and the y direction moving distance per unit time are assigned to the odometer for solution, and finally the result is provided to a mapping and positioning algorithm. The present invention has the advantages of simple principle, high intelligence, good control accuracy, etc.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention mainly relates to the field of robot control technology, and in particular to a method for obtaining a multi-motion modality underlying odometer. Background Art

[0002] Robot technology is developing rapidly, and various types of motion robots are emerging. After investigation, it is found that the motion modes of motion robots are mostly in a single control mode, such as Ackerman steering, differential steering, etc. A single control mode has disadvantages. For different motion states, such as straight, turning on the spot, turning, etc., the motion control method cannot be changed, and therefore the odometer calculation method will not change. The problem brought about by this is that the odometer positioning error caused by different motion states is different, and it is difficult to complete the positioning needs of robots with multiple motion states.

[0003] The existing methods have the following problems:

[0004] 1. Different motion states of the motion robot correspond to a single motion control mode, which will cause problems such as wheel side slip, bringing inevitable errors to the wheel odometer. The reason why it cannot be solved is that the mechanical structure itself is only suitable for a single motion control mode. When facing motion states such as straight-line driving, turning in place, and turning, it can only be achieved by sacrificing wheel grinding.

[0005] 2. A single control mode corresponds to a single odometer calculation algorithm. When faced with multiple motion states, different errors are generated, making the errors irregular and unable to be compensated, further increasing the inaccuracy of the odometer. A single motion control mode can only use a single calculation method based on a wheel odometer without the help of external forces (such as GPS, lidar, etc.).

[0006] In the prior art, for example, the Mecanum wheel odometer calculation method, the driving method of the Mecanum wheel is as follows Figure 6 As shown, through special design, the wheels can generate diagonal friction, allowing the vehicle body to move freely in all directions.

[0007] The motors are numbered in sequence: the left front is No. 1, the right front is No. 2, the right rear is No. 3, and the left rear is No. 4. Motor_1, Motor_2, Motor_3, and Motor_4 represent the mileage data fed back by the encoder disks of the four motors. When each wheel rotates, the mileage increase on the X and Y axes is:

[0008] X-axis Y-axis 1 +Motor_1 / 1.414 +Motor_1 / 1.414 2 -Motor_2 / 1.414 +Motor_2 / 1.414 3 +Motor_3 / 1.414 +Motor_3 / 1.414 4 -Motor_4 / 1.414 +Motor_4 / 1.414

[0009] The motion robot combined with Mecanum wheels only needs one motion control mode to complete multiple motion states well, and the odometer calculation accuracy is relatively high, which greatly reduces the mileage calculation error caused by wheel slippage. However, the problem is that Mecanum wheels have the following disadvantages:

[0010] 1. The structure is more complicated than ordinary wheels and difficult to maintain.

[0011] 2. Poor load-bearing capacity. The complex structure results in relatively small load-bearing components, and the load-bearing capacity is slightly worse than that of wheels of the same specifications.

[0012] 3. Terrain restrictions. Mecanum wheels are made of small wheels that are 45 degrees to the main wheels and contact the ground. The contact position not only changes in the rolling direction of the main wheels, but also in the direction of the wheel axle. This requires the tire to have a relatively flat bottom surface when traveling. For example, if the Mecanum wheel moves on two tracks that are much smaller than the width of the tire, it will be very bumpy. If the contact bottom surface is not parallel to the wheel axle, it will also be very bumpy. Summary of the invention

[0013] The technical problem to be solved by the present invention is: in response to the technical problems existing in the prior art, the present invention provides a method for obtaining a multi-motion modality underlying odometer with a simple principle, high intelligence and good control accuracy; the present invention can automatically identify the current motion control mode after the multi-motion modality robot receives the task requirement and switches the motion control mode to another mode, and then switches to the corresponding wheel odometer calculation method; the present invention uses different calculation methods for different motion states to effectively improve the accuracy of the odometer.

[0014] In order to solve the above technical problems, the present invention adopts the following technical solutions:

[0015] A method for obtaining a multi-motion modality underlying odometer, comprising:

[0016] Step S1: Get the current speed of the four wheels;

[0017] Step S2: Calculate the variance of the four wheels to determine whether there is an angular velocity at present;

[0018] Step S3: When the variance is less than 1, it is considered that the four wheels are parallel and have no angular velocity; the velocity component of each wheel speed to the vehicle body coordinate system is calculated, and the average speed of the four wheels in the x direction is calculated. The moving distance of the car in the x direction and the distance in the y direction per unit time are obtained by speed*unit time. The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer for solution, and finally the result is provided to the mapping and positioning algorithm;

[0019] Step S4: When the variance is greater than 1, the four wheels are not parallel and there is angular velocity. The x-direction velocity, y-direction velocity, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

[0020] As a further improvement of the present invention: in the step S1, the current speeds of the four wheels (v_lf, v_lb, v_rf, v_rb), the current angles of the four steering motors (angle_lf, angle_lb, angle_lb, angle_rf), and the mechanical dimensions are obtained through the motor encoder disk.

[0021] As a further improvement of the present invention: the step S3 includes:

[0022] Calculate the velocity component of each wheel speed to the vehicle body coordinate system;

[0023] Calculate the average speed of the four wheels in the x direction:

[0024] v_x_avg=(v_x_lf+v_x_lb+v_x_rf+v_x_rb) / 4.0;

[0025] Calculate the average speed of the four wheels in the y direction:

[0026] v_y_avg=(v_y_lf+v_y_lb+v_y_rf+v_y_rb) / 4.0;

[0027] By multiplying speed by unit time, we can get the distance the car moves in the x direction and the distance it moves in the y direction per unit time.

[0028] The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution, and finally the result is provided to the mapping and positioning algorithm.

[0029] As a further improvement of the present invention: the step S4 includes:

[0030] (1) As long as one wheel speed is 0, it is considered that the car is not moving or is faulty, and the x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are all taken as 0;

[0031] (2) When the wheel speed does not exist and is 0, according to the current wheel angle, v / w = R. Calculate the current speed components in x and y, add the offset of the wheel relative to the center, calculate the R of the current wheel, and calculate the current wheel angle;

[0032] (3) Calculate the average value of the rotation radius;

[0033] (4) Calculate the mean of the x and y velocity components respectively;

[0034] (5) According to the direction of velocity and angular velocity, the quadrant of the current rotation center is determined, and the direction of movement of the car is determined;

[0035] (6) Calculate the linear velocity by angular velocity*rotation radius;

[0036] (7) Calculate the average velocity in the x and y directions from the angle, linear velocity, and velocity direction;

[0037] (8) The moving distance of the car in the x direction and the distance in the y direction per unit time are obtained by multiplying speed by unit time;

[0038] (9) The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

[0039] As a further improvement of the present invention: the odometer reverse solution process includes:

[0040] Step S100: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values;

[0041] Step S200: When the angular velocity, linear velocity and heading angle are not 0, calculation is performed;

[0042] Step S300: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

[0043] As a further improvement of the present invention: the detailed process of the odometer reverse solution includes:

[0044] Step S1000: obtaining the linear velocity, angular velocity, orientation angle value and mechanical dimensions of the control vehicle;

[0045] Step S2000: When the linear velocity and angular velocity are both 0, the car does not move, and the angles and velocities of the four wheels are all 0;

[0046] Step S3000: When only the angular velocity is not 0, the car rotates in place, with the four wheels facing inward, the left front wheel and the right rear wheel turning to 45°, and the left rear wheel and the right front wheel turning to -45°; the speed of the right front wheel and the right rear wheel is angular velocity*wheel track / √2, and the speed of the right front wheel and the right rear wheel is -1*angular velocity*wheel track / √2;

[0047] Step S4000: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values;

[0048] Step S5000: when the angular velocity, linear velocity and direction angle are not 0;

[0049] Step S6000: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

[0050] As a further improvement of the present invention: the step S5000 includes:

[0051] Step S5001: Calculate the rotation radius;

[0052] Step S5002: Calculate the angle of each wheel according to the radius and the orientation angle, where angle is the orientation angle value and L_tmp is half of the wheelbase;

[0053] Step S5003: Calculate the rotation radius of each wheel;

[0054] Step S5004: Calculate the speed of each wheel by linear speed = angular speed * rotation radius;

[0055] Step S5005: Compare the difference between the current wheel angle and the calculated angle to be rotated to and the difference between the current wheel angle and the calculated reverse value of the angle to be rotated to, and select the nearest value for rotation; when selecting the reverse value, the wheel linear speed needs to be reversed.

[0056] Compared with the prior art, the advantages of the present invention are:

[0057] 1. The method for acquiring the multi-motion modality underlying odometer of the present invention has a simple principle, a high degree of intelligence, and good control accuracy. After the multi-motion modality robot receives the task requirement and switches the motion control mode to another mode, the present invention can automatically identify the current motion control mode and then switch to the corresponding wheel odometer calculation method; the present invention uses different calculation methods for different motion states, which can effectively improve the accuracy of the odometer.

[0058] 2. The method for obtaining the multi-motion mode underlying odometer of the present invention can be based on a four-turn four-wheel drive motion robot, aiming to utilize the flexible rotation of the four wheels, and can use multi-modal motion control to achieve different motion states, solving the problem that a single motion mode cannot fully adapt to different motion states; at the same time, multi-motion modes can match the calculation methods of different odometers, solving the problem that the error is irregular and cannot be compensated. By controlling the motion, the wheels can be well rubbed against the ground normally, greatly reducing or even eliminating the odometer calculation error caused by wheel side slip, and providing a more feasible solution to the demand for improving the accuracy of the wheel odometer of the motion robot without the help of external force.

[0059] 3. The method for obtaining the multi-motion mode underlying odometer of the present invention can freely switch the motion mode according to the different motion states of the robot, and the four wheels can rotate freely to meet the needs of motion. This can solve the disadvantages of a single traditional mode such as Ackerman steering and effectively solve the problem of wheels slipping against the ground.

[0060] 4. For robots with a single motion mode, the wheeled odometer can only use a single odometer calculation method without the help of external force, and cannot adopt corresponding calculation strategies for different motion states. The problem caused by this is that when a single calculation method faces different motion states, the errors that appear are different. Overall, the errors show irregularity and are incomparable, so the errors cannot be compensated. After adopting the method of the present invention, multiple motion modes can match different motion states, that is, different motion states can use different odometer calculation methods, which can greatly improve the accuracy of odometer calculation on the one hand, and at the same time, the causes of different errors can be effectively analyzed and compensated, further improving the accuracy of the odometer. BRIEF DESCRIPTION OF THE DRAWINGS

[0061] Figure 1 It is a schematic diagram of the process of the present invention.

[0062] Figure 2 It is a schematic diagram of the principle of the spin of the motion control mode in a specific application example of the present invention.

[0063] Figure 3 It is a schematic diagram of the principle of the oblique shift of the motion control mode in a specific application example of the present invention.

[0064] Figure 4 It is a schematic diagram of the principle of turning of the motion control mode in a specific application example of the present invention.

[0065] Figure 5 It is a schematic diagram of the coordinate axes of the present invention in a specific application example.

[0066] Figure 6 This is the driving method of the Mecanum wheel in the prior art. DETAILED DESCRIPTION

[0067] The present invention will be further described in detail below with reference to the accompanying drawings and specific embodiments.

[0068] The present invention is mainly applicable to a four-turn four-wheel drive robot, whose four wheels are respectively provided with steering gears that can change the direction of the wheels. Different combinations of the wheels that change direction can be transformed into a variety of motion control modes.

[0069] like Figure 1-Figure 4As shown, the present invention provides a method for obtaining a multi-motion modality underlying odometer, the steps of which include:

[0070] Step S1: Get the current speed of the four wheels;

[0071] Step S2: Calculate the variance of the four wheels to determine whether there is an angular velocity at present;

[0072] Step S3: When the variance is less than 1, it is considered that the four wheels are parallel and have no angular velocity; the velocity component of each wheel speed to the vehicle body coordinate system is calculated, and the average speed of the four wheels in the x direction is calculated. The moving distance of the car in the x direction and the distance in the y direction per unit time are obtained by speed*unit time. The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer for solution, and finally the result is provided to the mapping and positioning algorithm;

[0073] Step S4: When the variance is greater than 1, the four wheels are not parallel and there is angular velocity. The x-direction velocity, y-direction velocity, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

[0074] In a specific application example, in step S1, the current speeds of the four wheels (v_lf, v_lb, v_rf, v_rb), the current angles of the four steering motors (angle_lf, angle_lb, angle_lb, angle_rf), and the mechanical dimensions are obtained through the motor encoder disk.

[0075] In a specific application example, step S3 includes:

[0076] Calculate the velocity component of each wheel speed to the vehicle body coordinate system;

[0077] Calculate the average speed of the four wheels in the x direction:

[0078] v_x_avg=(v_x_lf+v_x_lb+v_x_rf+v_x_rb) / 4.0;

[0079] Calculate the average speed of the four wheels in the y direction:

[0080] v_y_avg=(v_y_lf+v_y_lb+v_y_rf+v_y_rb) / 4.0;

[0081] By multiplying speed by unit time, we can get the distance the car moves in the x direction and the distance it moves in the y direction per unit time.

[0082] The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution, and finally the result is provided to the mapping and positioning algorithm.

[0083] In a specific application example, step S4 includes:

[0084] (1) As long as one wheel speed is 0, it is considered that the car is not moving or is faulty, and the x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are all taken as 0;

[0085] (2) When the wheel speed does not exist and is 0, according to the current wheel angle, v / w = R. Calculate the current speed components in x and y, add the offset of the wheel relative to the center, calculate the R of the current wheel, and calculate the current wheel angle;

[0086] (3) Calculate the average value of the rotation radius;

[0087] (4) Calculate the mean of the x and y velocity components respectively;

[0088] (5) According to the direction of velocity and angular velocity, the quadrant of the current rotation center is determined, and the direction of movement of the car is determined;

[0089] (6) Calculate the linear velocity by angular velocity*rotation radius;

[0090] (7) Calculate the average velocity in the x and y directions from the angle, linear velocity, and velocity direction;

[0091] (8) The moving distance of the car in the x direction and the distance in the y direction per unit time are obtained by multiplying speed by unit time;

[0092] (9) The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

[0093] In a specific application example, the odometer reverse solution process includes:

[0094] Step S100: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values;

[0095] Step S200: When the angular velocity, linear velocity and heading angle are not 0, calculation is performed;

[0096] Step S300: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

[0097] As a further improvement of the present invention: the detailed process of the odometer reverse solution includes:

[0098] Step S1000: obtaining the linear velocity, angular velocity, orientation angle value and mechanical dimensions of the control vehicle;

[0099] Step S2000: When the linear velocity and angular velocity are both 0, the car does not move, and the angles and velocities of the four wheels are all 0;

[0100] Step S3000: When only the angular velocity is not 0, the car rotates in place, with the four wheels facing inward, the left front wheel and the right rear wheel turning to 45°, and the left rear wheel and the right front wheel turning to -45°; the speed of the right front wheel and the right rear wheel is angular velocity*wheel track / √2, and the speed of the right front wheel and the right rear wheel is -1*angular velocity*wheel track / √2;

[0101] Step S4000: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values;

[0102] Step S5000: when the angular velocity, linear velocity and direction angle are not 0;

[0103] Step S6000: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

[0104] In a specific application example, the step S5000 includes:

[0105] Step S5001: Calculate the rotation radius;

[0106] Step S5002: Calculate the angle of each wheel according to the radius and the orientation angle, where angle is the orientation angle value and L_tmp is half of the wheelbase;

[0107] Step S5003: Calculate the rotation radius of each wheel;

[0108] Step S5004: Calculate the speed of each wheel by linear speed = angular speed * rotation radius;

[0109] Step S5005: Compare the difference between the current wheel angle and the calculated angle to be rotated to and the difference between the current wheel angle and the calculated reverse value of the angle to be rotated to, and select the nearest value for rotation; when selecting the reverse value, the wheel linear speed needs to be reversed.

[0110] In conjunction with a specific application example, the detailed process of the present invention includes:

[0111] The specific calculation method is as follows: Figure 5 Coordinate axis, odometer forward solution process:

[0112] 1. Get the current speeds of the four wheels (v_lf, v_lb, v_rf, v_rb), the current angles of the four steering motors (angle_lf, angle_lb, angle_lb, angle_rf), and the mechanical dimensions through the motor encoder disk.

[0113] 2. Calculate the variance of the four wheels to determine whether there is angular velocity. When the variance is less than 1, it is considered that the four wheels are parallel and there is no angular velocity.

[0114] 3. When the variance is less than 1 (4 wheels are parallel)

[0115] (1) Calculate the velocity component of each wheel in the vehicle coordinate system.

[0116] The speed in the x direction is equal to the current speed of the wheel * the cosine of the current deflection of the wheel

[0117] The speed in the x direction is equal to the negative of the current speed of the wheel * the sine of the current deflection of the wheel

[0118] The details are as follows:

[0119] Calculate the speed of the left front wheel in the x direction: v_x_lf = v_lf*cos(angle_lf / 180*M_PI);

[0120] Calculate the speed of the left front wheel in the y direction: v_y_lf = -v_lf*sin(angle_lf / 180*M_PI);

[0121] Calculate the speed of the left rear wheel in the x direction: v_x_lb = v_lb*cos(angle_lb / 180*M_PI);

[0122] Calculate the speed of the left rear wheel in the y direction: v_y_lb = -v_lb*sin(angle_lb / 180*M_PI);

[0123] Calculate the speed of the right front wheel in the x direction: v_x_rf = v_rf*cos(angle_rf / 180*M_PI);

[0124] Calculate the speed of the right front wheel in the y direction: v_y_rf = -v_rf*sin(angle_rf / 180*M_PI);

[0125] Calculate the speed of the right rear wheel in the x direction: v_x_rb = v_rb*cos(angle_rb / 180*M_PI);

[0126] Calculate the speed of the right rear wheel in the y direction: v_y_rb = -v_rb*sin(angle_rb / 180*M_PI);

[0127] (2) Calculate the average speed of the four wheels in the x direction:

[0128] v_x_avg=(v_x_lf+v_x_lb+v_x_rf+v_x_rb) / 4.0;

[0129] Calculate the average speed of the four wheels in the y direction:

[0130] v_y_avg=(v_y_lf+v_y_lb+v_y_rf+v_y_rb) / 4.0;

[0131] (3) By multiplying speed by unit time, we can get the distance the car moves in the x direction and the distance it moves in the y direction per unit time.

[0132] (4) The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution, and finally the result is provided to the mapping and positioning algorithm.

[0133] 4. When the variance is greater than 1 (the four wheels are not parallel and there is angular velocity):

[0134] (1) As long as one wheel speed is 0, it is considered that the car is not moving or has a fault, and the x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are all taken as 0.

[0135] (2) When the wheel speed does not exist and is 0, based on the current wheel angle, v / w=R is used to calculate the x and y components of the current speed, and then the offset of the wheel relative to the center is added to calculate the R of the current wheel and the angle of the current wheel.

[0136] (3) Calculate the average value of the rotation radius.

[0137] (4) Calculate the mean of the x and y velocity components respectively.

[0138] (5) Based on the direction of velocity and angular velocity, the quadrant of the current rotation center is determined, and the direction of movement of the car is determined.

[0139] (6) The linear velocity is calculated by angular velocity*rotation radius.

[0140] (7) By angle, linear velocity, speed

[0141] Degree direction, find the average speed in the x and y directions

[0142] (8) The distance the car moves in the x direction and the distance in the y direction per unit time are obtained by multiplying speed by unit time.

[0143] (9) The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

[0144] The reverse calculation process of the odometer is as follows:

[0145] 1. Obtain the linear velocity, angular velocity, heading angle and mechanical dimensions of the controlled car.

[0146] 2. When the linear velocity and angular velocity are both 0, the car does not move, and the angles and speeds of the four wheels are all 0.

[0147] 3. When only the angular velocity is not 0, the car rotates in place, with the four wheels facing inward, the left front wheel and the right rear wheel turning to 45°, and the left rear wheel and the right front wheel turning to -45°. The speed of the right front wheel and the right rear wheel is angular velocity * wheelbase / The speed of the right front wheel and the right rear wheel is -1*angular velocity*wheelbase /

[0148] 4. When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value. The speeds of the four wheels are the current linear velocity values.

[0149] 5. When the angular velocity, linear velocity, and heading angle are not 0

[0150] (1) Calculate the rotation radius.

[0151] (2) Calculate the angle of each wheel based on the radius and the orientation angle, where angle is the orientation angle value and L_tmp is half of the wheelbase.

[0152] (3) Calculate the rotation radius of each wheel.

[0153] (4) Calculate the speed of each wheel by linear speed = angular speed * rotation radius.

[0154] (5) Compare the difference between the current wheel angle and the calculated angle to be rotated and the difference between the current wheel angle and the reverse value of the calculated angle to be rotated, and select the nearest value for rotation. When selecting the reverse value, the wheel linear speed needs to be reversed.

[0155] 6. Check whether the steering motor has been turned into position. If not, turn it into position first and then control the travel motor to rotate.

[0156] The above are only preferred embodiments of the present invention, and the protection scope of the present invention is not limited to the above embodiments. All technical solutions under the concept of the present invention belong to the protection scope of the present invention. It should be pointed out that for ordinary technicians in this technical field, some improvements and modifications without departing from the principle of the present invention should be regarded as the protection scope of the present invention.

Claims

1. A method for obtaining a multi-motion modality underlying odometer, characterized in that: include: Step S1: Get the current speed of the four wheels; Step S2: Calculate the variance of the four wheels to determine whether there is an angular velocity at present; Step S3: When the variance is less than 1, it is considered that the four wheels are parallel and have no angular velocity; calculate the velocity component of each wheel speed to the vehicle body coordinate system, calculate the average speed of the four wheels in the x direction, and use the speed Get the moving distance of the car in the x direction and the distance in the y direction per unit time, assign the x-direction speed, y-direction speed, x-direction moving distance per unit time and y-direction moving distance per unit time to the odometer solution, and finally provide the result to the mapping and positioning algorithm; Step S4: When the variance is greater than 1, the four wheels are not parallel and there is angular velocity. The x-direction velocity, y-direction velocity, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer for solution and finally provided to the mapping and positioning algorithm. The step S4 includes: (1) As long as there is a wheel whose speed is 0, it is considered that the car is not moving or is faulty, and the x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are all taken as 0; (2) When the wheel speed does not exist and the speed is 0, according to the current wheel angle, Calculate the x and y components of the current velocity, add the wheel's offset relative to the center, calculate the R of the current wheel, and calculate the angle of the current wheel; (3) Calculate the average value of the rotation radius; (4) Calculate the mean of the x and y velocity components respectively; (5) Based on the direction of velocity and angular velocity, the quadrant of the current rotation center is determined, and the direction of movement of the car is determined; (6) From the angular velocity The linear velocity is obtained from the rotation radius; (7) Calculate the average velocity in the x and y directions from the angle, linear velocity, and velocity direction; (8) Passing speed Get the moving distance of the car in the x direction and the distance in the y direction per unit time; (9) The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution and finally provided to the mapping and positioning algorithm.

2. The method for obtaining multi-motion modality underlying odometer according to claim 1, characterized in that: In step S1, the current speed of the four wheels is obtained through the motor encoder disk. , , , , Current angles of the four steering motors , , , , and mechanical dimensions.

3. The method for obtaining multi-motion modality underlying odometer according to claim 2, characterized in that: The step S3 includes: Calculate the velocity component of each wheel speed to the vehicle body coordinate system; Calculate the average speed of the four wheels in the x direction: ; Calculate the average speed of the four wheels in the y direction: ; Passing speed Get the moving distance of the car in the x direction and the distance in the y direction per unit time; The x-direction speed, y-direction speed, x-direction moving distance per unit time, and y-direction moving distance per unit time are assigned to the odometer solution, and finally the result is provided to the mapping and positioning algorithm.

4. The method for obtaining multi-motion modality underlying odometer according to any one of claims 1 to 3, characterized in that: Including the reverse solution of the odometer, the process includes: Step S100: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values; Step S200: When the angular velocity, linear velocity and heading angle are not 0, calculation is performed; Step S300: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

5. The method for obtaining multi-motion modality underlying odometer according to claim 4, characterized in that: The process of reverse calculation of the odometer includes: Step S1000: obtaining the linear velocity, angular velocity, orientation angle value and mechanical dimensions of the control vehicle; Step S2000: When the linear velocity and angular velocity are both 0, the car does not move, and the angles and velocities of the four wheels are all 0; Step S3000: When only the angular velocity is not 0, the car rotates in place, with the four wheels facing inward, the left front wheel and the right rear wheel turning to 45°, the left rear wheel and the right front wheel turning to -45°; the speed of the right front wheel and the right rear wheel is the angular velocity Wheelbase , the speed of the right front wheel and the right rear wheel is -1 Angular velocity Wheelbase ; Step S4000: When the angular velocity is 0 and the linear velocity is not 0, the angles of the four wheels are all turned to the direction of the angle value; the speeds of the four wheels are the current linear velocity values; Step S5000: when the angular velocity, linear velocity and direction angle are not 0; Step S6000: Determine whether the steering motor has been rotated to the correct position. If not, first rotate the steering motor to the correct position and then control the travel motor to rotate.

6. The method for obtaining multi-motion modality underlying odometer according to claim 5, characterized in that: The step S5000 includes: Step S5001: Calculate the rotation radius; Step S5002: Calculate the angle of each wheel based on the radius and the orientation angle, where is the orientation angle value, Half the wheelbase; Step S5003: Calculate the rotation radius of each wheel; Step S5004: Linear velocity = angular velocity The radius of rotation, calculate the speed of each wheel; Step S5005: Compare the difference between the current wheel angle and the calculated angle to be rotated to and the difference between the current wheel angle and the calculated reverse value of the angle to be rotated to, and select the nearest value for rotation; when selecting the reverse value, the wheel linear speed needs to be reversed.