Vehicle body motion control method and circuit and robot chassis control system

By calculating the real-time attitude and speed of the vehicle body and switching the walking mode according to environmental information, the problem of unstable driving path and slow response speed of the four-wheel drive and four-steering system in complex environments is solved, and a more efficient and flexible robot is achieved Motion control.

CN119037176AActive Publication Date: 2024-11-29中铁二十五局集团电务工程有限公司 +1
View PDF 2 Cites 0 Cited by

Patent Information

Application Number
CN202411277635.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-09-12
Publication Date
2024-11-29
Estimated Expiration
2044-09-12

AI Technical Summary

Technical Problem

The existing four-wheel drive four-steering system has insufficient traction, insufficient steering accuracy, large mechanical wear, high control complexity, slow response speed, high cost, large energy consumption and poor driving paths in complex environments. Problems such as stability limit the application efficiency and reliability of robots.

Method used

By obtaining the number of pulses of the steering motor and the walking motor, calculating the steering angle and walking speed, combining the relative position of the wheel body, the real-time attitude and speed of the vehicle body are obtained, and switching the walking mode according to the environmental road condition information can achieve the flexibility of the vehicle body movement and Accuracy.

Benefits of technology

It improves the accuracy and stability of vehicle body movement, enhances the application capabilities of robots in complex environments, reduces the complexity and energy consumption of the control system, and improves the response speed and reliability.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119037176A_ABST
    Figure CN119037176A_ABST
Patent Text Reader

Abstract

The invention discloses a vehicle body motion control method and circuit and a robot chassis control system, and the method comprises the steps: obtaining the number of phase difference pulses from zero position and the number of first period pulses of each steering motor, and calculating the current steering angle of each steering motor; the steering motor is used for controlling the wheel body to steer, acquiring the second period pulse number of each walking motor and calculating the current walking speed of each walking motor; the walking motors are used for controlling the wheel bodies to walk, obtaining the relative position of each wheel body relative to the vehicle body, obtaining the real-time posture and speed of the vehicle body in combination with the current steering angle of each steering motor and the current walking speed of each walking motor, and obtaining environment road condition information. And the walking modes of the vehicle body are switched based on the real-time posture and speed of the vehicle body, so that motion control over the vehicle body is achieved, and the flexibility and stability of robot movement are improved.
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 a vehicle body motion control method, circuit and a control system of a robot chassis. Background Art

[0002] In the development of robotics technology, robot control systems, as a key component of robots, have a decisive influence on the performance and application scope of robots. In the design of robots, robots are mainly controlled based on differential drive and Ackerman steering systems. Among them, the differential drive system is relatively simple to control, but faces the problem of insufficient traction in complex terrain or low-friction environment. At the same time, its large minimum turning radius limits the maneuverability of the robot in narrow spaces. Although the Ackerman steering system provides better steering accuracy, its complex structure and mechanical wear problems under heavy load or high speed conditions limit its effectiveness in specific applications.

[0003] With the evolution of technology, four-wheel drive and four-steering systems are gradually being applied to the chassis design of robots. The four-wheel drive and four-steering systems improve the flexibility and accuracy of the robot chassis movement by independently controlling the drive and steering of each wheel, enabling the robot to work effectively in a more complex and changing environment. However, the existing four-wheel drive and four-steering systems require complex control algorithms in practical applications, and have high requirements for processors, which increases the overall cost and energy consumption of the robot chassis control system. This complexity may also affect the response speed and reliability of the system. At the same time, the existing four-wheel drive and four-steering systems are insufficient in real-time response, especially when it is necessary to quickly adapt to environmental changes or perform emergency operations, which is affected by the action response time of the steering motor and the synchronization of multi-device control.

[0004] Furthermore, the existing four-wheel drive and four-steering control systems are insufficient in maintaining the accuracy and stability of the robot's driving path and direction, and this is particularly evident in complex or changing terrain, such as when turning, climbing, or dealing with slippery surfaces. At the same time, the control system is not sufficient to effectively adapt to changing environmental conditions, such as different ground frictions, slopes, or irregular surfaces, which limits the application efficiency and reliability of the robot in various scenarios. Summary of the invention

[0005] In order to solve the above technical problems, the present invention discloses a vehicle body motion control method, circuit and a control system of a robot chassis, which are used to improve the flexibility and accuracy of vehicle body motion.

[0006] In order to achieve the above objectives, in a first aspect, the present invention discloses a vehicle motion control method, comprising:

[0007] Obtaining the number of phase difference pulses from zero and the number of pulses in the first cycle of each steering motor, and calculating the current steering angle of each steering motor; the steering motor is used to control the steering of the wheel body;

[0008] Obtain the second cycle pulse number of each running motor and calculate the current running speed of each running motor; the running motor is used to control the wheel body to walk;

[0009] Get the relative position of each wheel relative to the vehicle body, and combine the current steering angle of each steering motor and the current travel speed of each running motor to get the real-time posture and speed of the vehicle body;

[0010] Acquire environmental road condition information and switch the vehicle's walking mode based on the vehicle's real-time posture and speed to achieve vehicle motion control.

[0011] The present invention discloses a vehicle motion control method, which calculates the steering angle and travel speed of the steering motor by acquiring the number of pulses in the steering motor and the travel motor of the vehicle, and simultaneously acquires the relative position of each wheel in the vehicle body relative to the vehicle body, so as to improve the calculation accuracy of the real-time posture and speed of the vehicle body by combining the relative position, steering angle and travel speed, thereby improving the accuracy of motion control; after generating the real-time posture and speed, the steering mode of the vehicle body is switched according to the current environmental road condition information, so as to improve the stability and flexibility of the vehicle body movement.

[0012] As a preferred example, the step of acquiring environmental road condition information and switching the walking mode of the vehicle body based on the real-time posture and speed of the vehicle body to achieve motion control of the vehicle body includes:

[0013] According to the speed of the vehicle and the preset speed threshold, the current speed level of the vehicle is obtained;

[0014] Based on the current speed level of the vehicle body, the running mode of the vehicle body is switched between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode.

[0015] The present invention switches the steering mode of the vehicle body based on the speed of the vehicle body and a preset speed threshold so as to achieve the best steering effect and driving stability at different speeds and improve the stability of the vehicle body movement.

[0016] As a preferred example, obstacle avoidance control and braking control are performed on the vehicle body based on the environmental road condition information.

[0017] The present invention performs obstacle detection based on the environmental road condition information, and further deeply integrates the obstacle detection with motion control. Through real-time detection of the operating environment of the vehicle body, safe obstacle avoidance and braking of the vehicle body are achieved, thereby improving the flexibility of vehicle movement.

[0018] As a preferred example, the real-time posture and speed of the vehicle body are integrated with time to obtain the first path of the vehicle body.

[0019] The present invention calculates the first path of the vehicle body according to the real-time posture and speed of the vehicle body, so as to provide accurate data for subsequent motion control of the vehicle body, thereby improving the accuracy and flexibility of the vehicle body motion control.

[0020] As a preferred example, the switching of the walking mode of the vehicle body based on the real-time posture and speed of the vehicle body to achieve motion control of the vehicle body includes:

[0021] Acquire a target path of the vehicle according to the first path and the environmental road condition information;

[0022] Acquire a target adjustment parameter of each wheel body based on the target path;

[0023] Each wheel is controlled according to the target adjustment parameter, thereby achieving motion control of the vehicle body.

[0024] The present invention obtains the historical first path and environmental road condition information, obtains the target path of the next form of the vehicle body, improves the accuracy of the vehicle body movement, and then converts the target path into the target adjustment parameters of the wheel body, and then uses the target adjustment parameters to control the wheel body to achieve precise movement control of the vehicle body.

[0025] In a second aspect, the present invention discloses a vehicle motion control circuit, including a main control module, a real-time processing module, a sensor module and a drive module; wherein:

[0026] The main control module is electrically connected to the real-time processing module to achieve information interaction;

[0027] The sensor module is electrically connected to the real-time processing module, and is used to collect the environmental road condition information of the vehicle body and the relative position of each wheel body relative to the vehicle body in real time, and send the environmental road condition information and the relative position to the real-time processing module;

[0028] The driving module is electrically connected to the real-time processing module, and is used to collect the number of phase difference pulses from zero and the number of pulses in the first cycle of each steering motor of the vehicle body and the number of pulses in the second cycle of each running motor, and send the number of phase difference pulses from zero, the number of pulses in the first cycle and the number of pulses in the second cycle to the real-time processing module;

[0029] The real-time processing module sends the number of zero phase difference pulses, the number of first cycle pulses, the number of second cycle pulses, the relative position and the environmental road condition information to the main control module, so that the main control module performs the following operations:

[0030] Calculating the current steering angle of each steering motor according to the number of pulses with a phase difference from zero and the number of pulses in the first cycle;

[0031] Calculate the current walking speed of each walking motor according to the number of pulses in the second cycle;

[0032] According to the relative position, combined with the current steering angle of each steering motor and the current travel speed of each travel motor, the real-time posture and speed of the vehicle body are obtained;

[0033] According to the environmental road condition information, and based on the real-time posture and speed of the vehicle body, the walking mode of the vehicle body is switched;

[0034] The main control module sends the real-time posture, speed and walking mode of the vehicle body to the real-time processing module, so that the real-time processing module controls the driving module to drive the steering motor and the running motor of the vehicle body according to the real-time posture, speed and walking mode to realize the motion control of the vehicle body.

[0035] The present invention discloses a vehicle motion control circuit, which first obtains the number of pulses in the steering motor and the running motor related to the vehicle motion through a driving module connected to a real-time processing module, and sends the pulse number to a main control module electrically connected to the real-time processing module, so that the main control module accurately calculates the current steering angle and running speed of the vehicle, so as to improve the control accuracy. Then the real-time processing module sends the environmental road condition information of the vehicle obtained through the sensor module to the main control module, so that the main control module calculates the real-time posture and speed of the vehicle in combination with the environmental road condition information and the steering angle and running speed, so as to improve the accuracy of motion control.

[0036] Furthermore, the main control module of the present invention also switches the steering mode of the vehicle body according to the real-time posture and speed, so as to achieve the best steering effect and driving stability of the vehicle body at different speeds and real-time postures.

[0037] As a preferred example, the real-time processing module is also used to perform obstacle avoidance control and braking control on the vehicle body based on the environmental road condition information.

[0038] The present invention combines the environmental road condition information to perform obstacle avoidance and braking on the vehicle body, thereby improving the flexibility of robot motion control and being able to adapt to different motion scene requirements.

[0039] As a preferred example, the main control module obtains the current speed level of the vehicle body according to the speed of the vehicle body and the preset speed threshold, and based on the current speed level of the vehicle body, switches the walking mode of the vehicle body between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode.

[0040] The present invention switches the steering mode of the vehicle body based on the speed of the vehicle body and a preset speed threshold so as to achieve the best steering effect and driving stability at different speeds and improve the stability of the vehicle body movement.

[0041] As a preferred example, the vehicle's travel modes include a front and rear wheel reverse steering mode and a front and rear wheel same-direction steering mode.

[0042] The present invention arranges the different steering modes to ensure the stability of the vehicle movement.

[0043] As a preferred example, the sensor module further includes an inertial sensor, which is electrically connected to the real-time processing module and is used to obtain the rotation angle of the vehicle body.

[0044] The present invention arranges the inertial sensor to obtain the rotation angle of the vehicle body, so as to improve the accuracy of vehicle body posture calculation, thereby improving the accuracy of vehicle body motion control.

[0045] As a preferred example, the sensor module is configured with a redundant structure.

[0046] The present invention uses a redundant structure to set the sensor module, so that when a sensor in the sensor module has a problem, the motion control of the vehicle body will not be affected, thereby improving the stability of the control.

[0047] In a third aspect, the present invention discloses a control system for a robot chassis, wherein the control system of the chassis comprises a vehicle motion control circuit as described in the second aspect, and is used to implement a vehicle motion control method as described in the first aspect. BRIEF DESCRIPTION OF THE DRAWINGS

[0048] Figure 1 : is a flow chart of a vehicle body motion control method disclosed in an embodiment of the present invention;

[0049] Figure 2 : is a structural schematic diagram of a vehicle body motion control circuit disclosed in an embodiment of the present invention;

[0050] Figure 3 : is a schematic structural diagram of a control system of a robot chassis disclosed in an embodiment of the present invention;

[0051] Figure 4 : A schematic diagram of a communication structure between a main control board and a real-time processing unit disclosed in an embodiment of the present invention;

[0052] Among them: 201, main control module; 202, real-time processing module; 203, sensor module; 204, drive module 204; 301, main control board; 302, real-time processing unit; 303, sensor component; 304, drive component; 305, running motor; 306, steering motor; 3031, ultrasonic sensor; 3032, anti-drop sensor; 3033, depth camera; 3034, two-dimensional laser; 3041, steering motor driver; 3042, running motor driver. DETAILED DESCRIPTION

[0053] The following will be combined with the drawings in the embodiments of the present invention to clearly and completely describe the technical solutions in the embodiments of the present invention. Obviously, the described embodiments are only part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of the present invention.

[0054] Embodiment 1

[0055] This embodiment discloses a vehicle motion control method. For the specific implementation process of the control method, please refer to Figure 1 , mainly including steps 101 to 104, wherein the steps are mainly:

[0056] Step 101: Obtain the number of phase difference pulses from zero and the number of pulses in the first cycle of each steering motor, and calculate the current steering angle of each steering motor; the steering motor is used to control the steering of the wheel.

[0057] Step 102: Obtain the second cycle pulse quantity of each running motor and calculate the current running speed of each running motor; the running motor is used to control the wheel body to run.

[0058] Step 103: Obtain the relative position of each wheel relative to the vehicle body, and obtain the real-time posture and speed of the vehicle body by combining the current steering angle of each steering motor and the current running speed of each running motor.

[0059] Step 104: Acquire environmental road condition information, and switch the vehicle's walking mode based on the vehicle's real-time posture and speed to achieve motion control of the vehicle.

[0060] In this embodiment, the vehicle motion control method further includes performing obstacle avoidance control and braking control on the vehicle based on the environmental road condition information, and integrating the real-time posture and speed of the vehicle over time to obtain a first path of the vehicle.

[0061] In this embodiment, step 104 also includes: obtaining a target path of the vehicle body according to the first path and the environmental road condition information; obtaining a target adjustment parameter of each wheel body based on the target path; and controlling each wheel body according to the target adjustment parameter, thereby achieving motion control of the vehicle body.

[0062] On the other hand, this embodiment also discloses a vehicle motion control circuit. For the specific structure of the vehicle motion control circuit, please refer to Figure 2 , including a main control module 201, a real-time processing module 202, a sensor module 203 and a drive module 204, wherein the main control module 201 is electrically connected to the real-time processing module to realize information exchange; the sensor module 203 is electrically connected to the real-time processing module 202, and is used to collect the environmental road condition information of the vehicle body and the relative position of each wheel body relative to the vehicle body in real time, and send the environmental road condition information and the relative position to the real-time processing module 202; the drive module 204 is electrically connected to the real-time processing module 202, and is used to collect the number of phase difference pulses from zero and the number of first cycle pulses of each steering motor of the vehicle body and the number of second cycle pulses of each running motor, and send the number of phase difference pulses from zero, the number of first cycle pulses and the number of second cycle pulses to the real-time processing module 202;

[0063] The real-time processing module 202 sends the number of zero phase difference pulses, the number of first cycle pulses, the number of second cycle pulses, the relative position and the environmental road condition information to the main control module 201, so that the main control module 201 performs the following operations:

[0064] Calculating the current steering angle of each steering motor according to the number of pulses with a phase difference from zero and the number of pulses in the first cycle;

[0065] Calculate the current walking speed of each walking motor according to the number of pulses in the second cycle;

[0066] According to the relative position, combined with the current steering angle of each steering motor and the current travel speed of each travel motor, the real-time posture and speed of the vehicle body are obtained;

[0067] According to the environmental road condition information, and based on the real-time posture and speed of the vehicle body, the walking mode of the vehicle body is switched;

[0068] The main control module 201 sends the real-time posture, speed and walking mode of the vehicle body to the real-time processing module 202, so that the real-time processing module 202 controls the driving module 204 to drive the steering motor and the running motor of the vehicle body according to the real-time posture, speed and walking mode to realize the motion control of the vehicle body.

[0069] In this embodiment, the real-time processing module 202 is also used to perform obstacle avoidance control and braking control on the vehicle body based on the environmental road condition information. The main control module 201 obtains the current speed level of the vehicle body according to the speed of the vehicle body and the preset speed threshold, and switches the vehicle body's walking mode between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode based on the current speed level of the vehicle body, wherein the vehicle's walking mode includes the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode.

[0070] In this embodiment, the sensor module 203 further includes an inertial sensor, which is electrically connected to the real-time processing module 202 and is used to obtain the rotation angle of the vehicle body. The sensor module 203 is configured with a redundant structure.

[0071] According to the above-mentioned vehicle motion control method and circuit, this embodiment further discloses a control system of a robot chassis, wherein the control system of the chassis includes a vehicle motion control circuit described in this embodiment, which is used to implement a vehicle motion control method described in this embodiment.

[0072] Specifically, in one implementation, this embodiment discloses a control system for a robot chassis. For the specific structural composition of the control system of the chassis, please refer to Figure 3 ,like Figure 3 As shown, it includes a main control board 301, a real-time processing unit 302, a sensor component 303, a drive component 304, a running motor 305 and a steering motor 306. In this embodiment, the running motor 305 is set to control the movement of the robot chassis, and the steering motor 306 controls the steering of the robot chassis.

[0073] Specifically, refer to Figure 3 The main control board 301 is electrically connected to the real-time processing unit 302 for information exchange. Optionally, refer to Figure 4 This embodiment discloses a communication structure between a main control board 301 and the real-time processing unit 302, wherein a plurality of communication serial ports are respectively provided on the main control board 301 and the real-time processing unit 302, such as the first communication serial port and the second communication serial port. Furthermore, a communication unit is provided between the main control board 301 and the real-time processing unit 302, and information interaction between the main control board 301 and the real-time processing unit 302 is performed through the communication unit.

[0074] Specifically, refer to Figure 3The sensor component 303 includes an ultrasonic sensor 3031, an anti-fall sensor 3032, a depth camera 3033 and a two-dimensional laser 3034, wherein the depth camera 3033 and the two-dimensional laser 3034 are used to obtain the current spatial position of the robot and the relative position of each wheel of the robot relative to the robot body, and send the relative position and the spatial position to the real-time processing unit 302, and the ultrasonic sensor 3031 and the anti-fall sensor 3032 are used to obtain obstacle information during the movement of the robot, and send the obstacle information to the real-time processing unit 302, and then the real-time processing unit 302 sends the obstacle information, the relative position and the spatial position to the main control board 301.

[0075] Optionally, in this embodiment, refer to Figure 4 It can be known that the multiple communication serial ports arranged on the real-time processing unit 302 are respectively connected to the CAN bus, serial port line, IO control line and IO acquisition line, and then connected to the interface unit through the CAN bus, serial port line, IO control line and IO acquisition line, and then electrically connected to the sensor component 303 through the interface unit, so as to receive the obstacle information and the relative position and the spatial position fed back by the sensor component 303.

[0076] In one embodiment, a plurality of the ultrasonic sensors 3031, anti-fall sensors 3032, depth cameras 3033 and two-dimensional lasers 3034 are arranged in multiple directions on the robot, and then the ultrasonic sensors 3031 and the anti-fall sensors 3032 are used to detect obstacle information during the robot's walking process in real time, and the obstacle information is sent to the real-time processing unit 302 of the robot in real time, while the depth camera 3033 and the two-dimensional laser 3034 are used to detect the robot's spatial position in real time and collect the relative position of each wheel of the robot relative to the robot body, and send the relative position and the spatial position to the real-time processing unit 302.

[0077] Specifically, refer to Figure 3 The driving component 304 includes a steering motor driver 3041 and a running motor driver 3042, wherein the steering motor driver 3041 and the running motor driver 3042 are respectively connected to the real-time processing unit 302, wherein the steering motor driver 3041 collects the number of zero phase difference pulses and the number of first cycle pulses of each steering motor in the robot, and sends the number of zero phase difference pulses and the number of first cycle pulses to the real-time processing module 302, and the running motor driver 3042 collects the number of second cycle pulses of each running motor and sends the second cycle pulse number to the real-time processing module 302.

[0078] Specifically, refer to Figure 4 The real-time processing unit 302 communicates with the steering motor driver 3041 and the running motor driver 3042 through the CAN bus, respectively, to receive the number of zero phase difference pulses, the number of first cycle pulses and the number of second cycle pulses.

[0079] Reference Figure 3 The main control board 301 receives the number of zero phase difference pulses, the number of first cycle pulses and the number of second cycle pulses sent by the real-time processing unit 302, and calculates the current steering angle of the steering motor according to the number of zero phase difference pulses and the number of first cycle pulses, and calculates the movement speed of the running motor according to the number of second cycle pulses.

[0080] The main control board 301 receives the relative position of each wheel body relative to the robot body sent by the real-time processing unit 302, and combines the steering angle and the movement speed to calculate the posture, linear velocity and angular velocity of each wheel body mapped to the geometric center of the robot through geometric relationships, and then averages the posture, linear velocity and angular velocity of each wheel in the multiple wheels of the robot to calculate the current real-time posture and real-time speed of the robot, and integrates the real-time posture and the real-time speed to obtain the first motion trajectory of the robot, wherein the first motion trajectory is the planar displacement accumulated after the robot is initialized.

[0081] In one embodiment, when the robot is a four-wheel drive robot, the four-wheel drive robot includes wheels arranged in four directions of the robot, and the four-wheel drive robot is configured with 4 independent steering motors and 4 independent running motors, each steering motor and running motor corresponding to a wheel body respectively. In this embodiment, the main control board 301 calculates the real-time posture and speed of each wheel body in the four-wheel drive robot, combines the relative position of each wheel body relative to the robot body, and then calculates the posture and speed of each wheel body mapped to the robot according to the relative position, and merges the posture and speed of the four wheels mapped to the robot to obtain the real-time posture and speed of the four-wheel drive robot, and integrates the real-time posture and speed over time to generate the historical motion trajectory of the four-wheel drive robot.

[0082] The main control board 301 calculates the target path of the robot on the required path based on the first motion trajectory and the spatial position received from the real-time processing unit 302, wherein the target path is the steering angle and movement speed that the robot needs to move, and the main control board 301 switches the steering mode of the robot based on the steering angle and movement speed, wherein the steering mode includes a front and rear wheel reverse steering mode and a front and rear wheel same-direction steering mode.

[0083] An upper-level path planning device is provided with reference to the implementation method provided in this embodiment, wherein the path planning device is connected to the main control board 301, wherein the main control board 301 sends the spatial position and the first motion trajectory to the upper-level path planning device, and the path planning device calculates the movement speed and angular velocity of the robot when it moves next based on the target path, the spatial position and the upper-level path planning device, and sends the movement speed and the angular velocity to the main control board 301 of the robot.

[0084] Furthermore, after calculating the movement speed and the movement angular velocity, the upper-layer path planning device sets a control algorithm to realize the steering control of the robot. The control algorithm can switch between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode according to the robot's speed level, steering angle, turning radius, lateral acceleration and other parameters.

[0085] Specifically, the movement speed of the robot is the main basis for switching the mode, but the steering mode can also be switched according to the actual movement of the robot. Specifically, the switching mode can include multiple bases:

[0086] According to 1, a low speed threshold and a high speed threshold are set. When the moving speed is lower than the low speed threshold, the upper path planning device tends to select the front and rear wheel reverse steering mode. When the vehicle speed is higher than or equal to the high speed threshold, the path planning device tends to select the front and rear wheel same direction steering mode.

[0087] According to 2, the path planning device obtains the steering angle and turning radius of the robot. At low speed, if the steering angle is large or the turning radius is small, the path planning device may tend to select the front and rear wheel reverse steering mode to achieve a smaller turning radius. At high speed, the path planning device may tend to select the front and rear wheel same-direction steering mode to maintain stability.

[0088] Basis 3 is: The path planning device can also monitor the lateral acceleration of the robot. At low speeds, if a higher lateral acceleration is required to complete a turn, the path planning device may select a front and rear wheel reverse steering mode, while at high speeds, the path planning device may select a front and rear wheel same-direction steering mode to reduce the impact of lateral acceleration on the robot's stability.

[0089] Furthermore, a rear wheel non-steering mode may be added as an intermediate state. This rear wheel non-steering mode, as an intermediate state between the above two steering modes, can buffer the sudden change in the robot state caused by the switching between the two modes.

[0090] The upper-level path planning device sends the switched steering mode and the movement speed and movement angular velocity to the main control board 301. The main control board 301 calculates the target running speed and target steering angle of each wheel body according to the movement speed and the movement angular velocity, and generates the target running speed and target steering angle and a control signal corresponding to the steering mode and sends it to the real-time processing unit 302, so that the real-time processing unit 302 generates control instructions for the driver of each steering motor and the driver of the running motor according to the control signal, and then controls the driver to drive the steering motor and the running motor according to the control instruction.

[0091] During the movement of the robot, the implementation processing unit 302 obtains obstacle information fed back by the sensor component in real time, and controls the robot to brake or continue to move according to the obstacle information.

[0092] Specifically, referring to the implementation method provided in this embodiment, 8 ultrasonic sensors and 8 anti-fall sensors are configured in the robot, which are respectively arranged in 4 directions of the robot. The ultrasonic sensors and the anti-fall sensors are used to detect obstacle information during the robot's walking process in real time, and the obstacle information is sent to the real-time processing unit 302 of the robot in real time.

[0093] The real-time processing unit 302 determines whether the robot continues to walk based on the detected obstacle distance and the robot, and the received movement speed and steering angle. If it is determined that the robot cannot continue to walk, the real-time processing unit 302 controls the robot's brake motor to shut down the robot. If it is determined that the robot can continue to walk, the real-time processing unit 302 controls the steering motor and the traveling motor to continue moving or controls the robot's brake motor to exit braking.

[0094] Furthermore, in this embodiment, an inertial sensor can also be set in the sensor component 303. The inertial sensor can measure the rotation angle of the robot relative to the initial position through a high-precision sensor, and perform real-time calibration of the robot's posture through inertial navigation, which can ensure that the current robot posture error is within a certain range, thereby effectively improving the accuracy of the robot's motion control.

[0095] A motion control method for a robot disclosed in this embodiment adopts a dual redundant structure, which is divided into a main control board and a real-time processing unit. No matter which module has an abnormality, the robot will enter a safe parking mode to ensure the safety of operation. At the same time, a dual processor is used for control, which can ensure real-time performance while improving the calculation rate. Safety protection sensors are set, including ultrasonic anti-collision sensors and anti-fall sensors with a redundant structure. Even if individual sensors have abnormalities, it will not affect the safety protection of the robot. At the same time, the rotation angle of each wheel in the robot can reach 360°. Therefore, the robot supports multiple walking modes, including differential mode, Ackerman mode, dual Ackerman mode, lateral walking, oblique straight walking, etc., which can be achieved through different algorithm modules, and switching between modules can be achieved through the host computer.

[0096] Furthermore, in the control algorithm, the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode can be switched according to the speed level. The advantage of the front and rear wheel reverse steering mode is that the turning radius can be small enough, and thus its turning flexibility is high enough, but when the speed exceeds the critical value, it will cause the robot to become unstable; the advantage of the front and rear wheel same-direction steering mode is that the stability is high at high speed, but the turning flexibility is insufficient. Switching between the two according to the different driving speeds can fully meet the robot driving under different speed conditions. The feedback control mechanism is introduced in the control strategy. The robot can calculate the mileage information according to the steering and running speed of each wheel through the physical geometric model, including the linear velocity and angular velocity in the previous control cycle, and use it as the response input of this control cycle to realize feedback control based on the motion state, which fully improves the robustness of the robot operation. Even when the wheel friction and wind resistance have a large impact, it can also meet the control requirements well. In terms of safety protection, it fully considers how to deeply integrate the safety protection based on ultrasonic and anti-fall sensors with robot control.

[0097] Since the robot has high turning flexibility, the real-time monitoring of the robot's operating environment is achieved through sensors, thereby realizing safe braking and exit braking of the robot, ensuring flexible operation while also considering the safety of the robot.

[0098] The specific embodiments described above further illustrate the purpose, technical solutions and beneficial effects of the present invention. It should be understood that the above description is only a specific embodiment of the present invention and is not intended to limit the scope of protection of the present invention. It is particularly pointed out that for those skilled in the art, any modification, equivalent replacement, improvement, etc. made within the spirit and principle of the present invention should be included in the scope of protection of the present invention.

Claims

1. A vehicle motion control method, characterized in that: The following steps are involved: Obtain the number of phase difference pulses from zero and the number of pulses in the first cycle of each steering motor, and calculate the current steering angle of each steering motor; The steering motor is used to control the steering of the wheel body; Obtain the number of second cycle pulses of each running motor and calculate the current running speed of each running motor; The traveling motor is used to control the walking of the wheel body; Get the relative position of each wheel relative to the vehicle body, and combine the current steering angle of each steering motor and the current travel speed of each running motor to get the real-time posture and speed of the vehicle body; Acquire environmental road condition information and switch the vehicle's walking mode based on the vehicle's real-time posture and speed to achieve vehicle motion control.

2. A vehicle motion control method according to claim 1, characterized in that: The step of acquiring environmental road condition information and switching the walking mode of the vehicle body based on the real-time posture and speed of the vehicle body to realize the motion control of the vehicle body includes: According to the speed of the vehicle and the preset speed threshold, the current speed level of the vehicle is obtained; Based on the current speed level of the vehicle body, the running mode of the vehicle body is switched between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode.

3. A vehicle motion control method according to claim 1, characterized in that: It also includes, based on the environmental road condition information, performing obstacle avoidance control and braking control on the vehicle body.

4. A vehicle motion control method according to claim 1, characterized in that: The method also includes integrating the real-time posture and speed of the vehicle body over time to obtain a first path of the vehicle body.

5. A vehicle motion control method according to claim 4, characterized in that: The step of switching the walking mode of the vehicle body based on the real-time posture and speed of the vehicle body to realize the motion control of the vehicle body includes: Acquire a target path of the vehicle according to the first path and the environmental road condition information; Acquire a target adjustment parameter of each wheel body based on the target path; Each wheel is controlled according to the target adjustment parameter, thereby achieving motion control of the vehicle body.

6. A vehicle motion control circuit, characterized in that: It includes a main control module, a real-time processing module, a sensor module and a drive module; among which: The main control module is electrically connected to the real-time processing module to achieve information interaction; The sensor module is electrically connected to the real-time processing module, and is used to collect the environmental road condition information of the vehicle body and the relative position of each wheel body relative to the vehicle body in real time, and send the environmental road condition information and the relative position to the real-time processing module; The driving module is electrically connected to the real-time processing module, and is used to collect the number of phase difference pulses from zero and the number of pulses in the first cycle of each steering motor of the vehicle body and the number of pulses in the second cycle of each running motor, and send the number of phase difference pulses from zero, the number of pulses in the first cycle and the number of pulses in the second cycle to the real-time processing module; The real-time processing module sends the number of zero phase difference pulses, the number of first cycle pulses, the number of second cycle pulses, the relative position and the environmental road condition information to the main control module, so that the main control module performs the following operations: Calculating the current steering angle of each steering motor according to the number of pulses with a phase difference from zero and the number of pulses in the first cycle; Calculate the current walking speed of each walking motor according to the number of pulses in the second cycle; According to the relative position, combined with the current steering angle of each steering motor and the current travel speed of each travel motor, the real-time posture and speed of the vehicle body are obtained; According to the environmental road condition information, and based on the real-time posture and speed of the vehicle body, the walking mode of the vehicle body is switched; The main control module sends the real-time posture, speed and walking mode of the vehicle body to the real-time processing module, so that the real-time processing unit controls the driving module to drive the steering motor and the running motor of the vehicle body according to the real-time posture, speed and walking mode to realize the motion control of the vehicle body.

7. A vehicle motion control circuit according to claim 6, characterized in that: The real-time processing module is also used to perform obstacle avoidance control and braking control on the vehicle body based on the environmental road condition information.

8. A vehicle motion control circuit according to claim 6, characterized in that: The main control module obtains the current speed level of the vehicle body according to the speed of the vehicle body and the preset speed threshold, and switches the running mode of the vehicle body between the front and rear wheel reverse steering mode and the front and rear wheel same-direction steering mode based on the current speed level of the vehicle body.

9. A vehicle motion control circuit according to claim 8, characterized in that: The vehicle's travel modes include a front and rear wheel reverse steering mode and a front and rear wheel same-direction steering mode.

10. A vehicle motion control circuit according to claim 6, characterized in that: The sensor module further includes an inertial sensor, which is electrically connected to the real-time processing module and is used to obtain the rotation angle of the vehicle body.

11. A vehicle motion control circuit according to claim 6, characterized in that: The sensor module is configured with a redundant structure.

12. A control system for a robot chassis, characterized in that: The control system of the chassis includes a vehicle motion control circuit as described in any one of claims 6-11, which is used to implement a vehicle motion control method as described in any one of claims 1-5.

Citation Information

Patent Citations

  • Full-drive-by-wire omnidirectional vehicle chassis system and control method

    CN113022286A

  • Control method and system for chassis of omni-directional terrain self-adaptive wheeled robot

    CN115951664A