Control algorithm for curve walking of four-steering-wheel chassis

The control algorithm for a four-steering wheel chassis addresses the limitations of existing drive wheels by real-time adjustment of steering angles and speeds, ensuring stable and efficient curved movement with minimal energy use.

CN119088020APending Publication Date: 2024-12-06SHENYANG FEIYAN AVIATION EQUIP
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202411209481.7
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-08-30
Publication Date
2024-12-06

AI Technical Summary

Technical Problem

Existing self-propelled military aircraft ground support equipment with hydraulic or motor drive wheels face issues such as slow travel speed, low accuracy, high energy consumption, and instability during curved movement, particularly with Mecanum and differential wheels.

Method used

A control algorithm for a four-steering wheel chassis that uses symmetrically mounted steering wheels with servo motors and a programmable logic controller to adjust steering angles and speeds in real-time, ensuring stable curved movement by calculating turning radii and angular velocities for each wheel.

Benefits of technology

The algorithm achieves high accuracy, zero internal energy consumption, smooth operation, and strong ground adaptability, enabling stable curved walking forward or backward with enhanced load-carrying capacity.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119088020A_ABST
    Figure CN119088020A_ABST
Patent Text Reader

Abstract

The invention belongs to the technical field of self-walking chassis, and particularly relates to a control algorithm for curve walking of a four-steering-wheel chassis. The invention provides a four-steering-wheel chassis curve walking control device which comprises a chassis, a programmable logic controller, four sets of steering wheels, steering servo motors and walking servo motors, the four sets of steering wheels are symmetrically installed on the chassis, the front two of the four sets of steering wheels are the steering wheels, the rear two of the four sets of steering wheels are the walking steering wheels, and the walking servo motors are arranged on the chassis. The steering servo motor is connected with the steering wheel, and the walking servo motor is connected with the walking steering wheel. According to the control algorithm for curve walking of the four-steering-wheel chassis, the walking distance control precision is high, internal energy consumption is avoided during self-walking, the steering wheel chassis walks stably, the ground adaptability is high, the loading capacity is high, and curve walking during advancing or retreating can be achieved.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention belongs to the technical field of self-propelled chassis, and in particular relates to a control algorithm for a four-steering wheel chassis to walk in curves. Background Art

[0002] In the field of aerospace, more and more self-propelled military aircraft ground support equipment are used, including traction equipment, engine disassembly and assembly equipment, and bomb assembly equipment. Common self-propelled chassis of support equipment are generally hydraulic drive wheels or motor drive wheels. Hydraulic drive wheels have slow travel speed and low travel distance control accuracy. Motor drive wheels include Mecanum wheels or differential control wheels. Mecanum wheels rely on the combined force of four wheels to achieve chassis motion control. When combined force is applied, the internal energy consumption is large and the flatness of the walking ground is required to be high. The differential chassis relies on the speed and direction of rotation of the inner and outer drive wheels to achieve steering. The energy consumption will increase during the steering process, and there will be wheel slippage and chassis vibration.

[0003] The four-steering wheel chassis has high travel distance control accuracy, no internal energy consumption during self-propelled walking, stable travel, strong ground adaptability and load-carrying capacity, and can realize curved walking while moving forward or backward, which can meet the needs of high-precision use. Therefore, a control algorithm for curved walking of a four-steering wheel chassis is proposed. Summary of the invention

[0004] The present invention provides a control algorithm for a four-steering wheel chassis walking in a curve. The method enables the two front steering wheels of the four-steering wheel chassis to turn left or right at any time when walking in a straight line to adjust the travel direction of the entire chassis. When walking in a curve, the steering angles and travel speeds of the four steering wheels are matched in real time to ensure stable walking of the chassis in the curve.

[0005] In order to solve the above technical problems, the technical solution provided by the present invention is: a control device for curved walking of a four-steering wheel chassis, comprising a chassis, a programmable logic controller, four groups of steering wheels, a steering servo motor and a walking servo motor, the four groups of steering wheels are symmetrically installed on the chassis, and the first two of the four groups of steering wheels are steering steering wheels, and the last two are walking steering wheels, the steering servo motor is connected to the steering steering wheel, and the walking servo motor is connected to the walking steering wheel.

[0006] A control algorithm for a four-steering wheel chassis walking in a curve, defining the right front steering wheel as 1, the left front steering wheel as 2, the left rear steering wheel as 3, and the right rear steering wheel as 4. When turning right, the angle A S and speed V S Assign value to steering wheel 1, i.e. A1 = A S 、V1=V S , other steering wheel angle and speed calculations are:

[0007] Step 1: The turning radius R1 from the center of the circle to the steering wheel 1 is: Where L is the distance between steering wheel 2 and steering wheel 3;

[0008] Step 2: The turning radius R4 from the center of the circle to the steering wheel 4 is:

[0009] Step 3: The turning radius R2 from the center of the circle to the steering wheel 2 is: Where T is the distance between steering wheel 1 and steering wheel 2;

[0010] Step 4, the turning radius R3 from the center of the circle to the steering wheel 3 is: R3 = R4 + T;

[0011] Step 5, the angular velocity W of the chassis when walking in a curve is:

[0012] Step 6, the turning angle A2 of steering wheel 2 is:

[0013] Step 7, according to the relationship between linear velocity and angular velocity: V = WR, V2, V3, and V4 can be calculated;

[0014] Step 8: When turning right, the steering wheel 3 and the steering wheel 4 do not turn, A3 = A4 = 0;

[0015] Step 9: The rotation angles and travel speeds of the four steering wheels have been calculated. Similarly, when a left turn is required, the center of the circle is on the left side of the vehicle, the known rotation angle and speed are assigned to steering wheel 2, and the rotation angles and speeds of the remaining steering wheels are calculated according to the above calculation steps.

[0016] Preferably, the steering servo motor adopts an absolute encoder. Regardless of whether the servo motor is powered, the encoder can record the current steering angle. When the steering servo motor and the programmable logic controller are powered on, the steering servo motor can feed back the position to the programmable logic controller in real time.

[0017] Preferably, when the steering angle of the chassis is zero during movement, the chassis moves in a straight line, and when the front steering wheel is given a certain steering angle in a given walking direction, the chassis moves in a curve.

[0018] Preferably, when the steering angle of the chassis is not zero during movement, the steering angle and the walking speed of the steering wheel should be calculated separately according to the algorithm, wherein when the given steering angle is A S When the steering wheel is turned to A S Angle. Since the calculation of the walking speed is related to the distance from the center of the curve to each steering wheel, and the position of the center of the curve is related to the current angle of the steering wheel, the calculation of the walking speed should be based on the angle A fed back by the steering wheel in real time. F To calculate, before the steering angle reaches A S When in position, the walking speed is based on A FChanges in real time.

[0019] Preferably, the feedback angle A F It is calculated through the real-time feedback encoding of the steering servo motor and the steering wheel (number of large and small gears, reduction ratio) parameters.

[0020] Preferably, the coding of the steering servo motor is fed back in real time through industrial bus communication between a programmable logic controller and a servo driver, and the programmable logic controller reads the coding value of the servo motor in real time.

[0021] The advantages of the present invention compared with the prior art are:

[0022] The control algorithm for the curved walking of the four-steering wheel chassis has high walking distance control accuracy, no internal energy consumption during self-walking, the steering wheel chassis walks smoothly, has strong ground adaptability and load-carrying capacity, and can realize curved walking while moving forward or backward. BRIEF DESCRIPTION OF THE DRAWINGS

[0023] Figure 1 This is a schematic diagram of a control algorithm for curved walking of a four-steering wheel chassis while moving forward according to the present invention.

[0024] Figure 2 This is a schematic diagram of a right turn curve walking while moving forward according to a control algorithm for curve walking of a four-steering wheel chassis of the present invention.

[0025] Figure 3 The present invention is a schematic diagram of a control algorithm for curved walking of a four-steering wheel chassis when moving backwards and turning left.

[0026] Figure 4 The present invention is a schematic diagram of a right turn curve walking when retreating according to a control algorithm of a four-steering wheel chassis curve walking. DETAILED DESCRIPTION

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

[0028] The four steering wheels of the present invention are symmetrically mounted on the chassis. This mounting method has a strong load-carrying capacity and will not cause the chassis to roll over due to the center of gravity shift after the upper structure of the chassis is loaded. In addition, when moving in a curve, the programmable logic controller determines the steering angle in real time to accurately control the walking speed. Figures 1 to 4As shown, four steering wheels are symmetrically installed on the chassis, the distance between steering wheel 2 and steering wheel 3 is L, the distance between steering wheel 1 and steering wheel 2 is T, the distances from the center of the curve to the four steering wheels are R1, R2, R3, and R4, respectively, and the steering angles of the four steering wheels are A1, A2, A3, and A4, respectively. According to the direction of travel, the steering wheels are divided into the front steering wheel and the rear steering wheel. When walking on the curve, the front steering wheel is the steering wheel, and the rear steering wheel is the directional wheel, that is, A=0. When moving forward, the steering wheel 1 is the reference wheel for right turn, and the steering wheel 2 is the reference value for left turn when moving forward. When moving backward, the steering wheel 3 is the reference wheel for left turn, and the steering wheel 4 is the reference wheel for right turn when moving backward.

[0029] like Figure 1 The figure shows a schematic diagram of a curve walking with a right turn while moving forward. When turning right while moving forward, the steering wheel 1 is used as the reference wheel, and the steering angle A obtained by the controller S and speed V S Assign value to the reference wheel, i.e. A1 = A S 、V1=V S are known parameters. The relationship between the steering angles of the four steering wheels and the travel speed is as follows:

[0030]

[0031]

[0032] Through the above formula, the steering angles A2, A3, A4 and the walking speeds V2, V3, V4 of the other three steering wheels can be calculated, so as to realize the control of the steering wheel chassis curve walking and steering, and ensure that the chassis runs in a stable state.

[0033] like Figure 2 The figure shows a schematic diagram of turning right while walking in a curve when moving backward. The algorithm and control principle are the same as those of turning right while moving forward.

[0034] In actual control, the steering angle does not reach the specified angle A instantly when walking on a curve. S , it takes a process, especially when the continuous curve movement between left turn or right turn, the steering angle range is large, and it takes a long time to reach the specified angle A S The time becomes longer, so the walking speed of each steering wheel is not directly controlled by the given steering angle A. S Instead, the current angle A of the reference steering wheel is used. F to calculate.

[0035] When moving forward, the reference steering wheel for turning left is steering wheel 2, and when moving forward, the reference steering wheel for turning right is steering wheel 1. The corresponding current angle feedback value is A 2F , A 1F According to the relationship between the walking speed and steering angle of the four steering wheels analyzed by the above algorithm, the following is a detailed explanation of the relationship between turning left and right while moving forward:

[0036] 1. The steering angles of steering wheel 1 and steering wheel 2 are distinguished by positive and negative when turning left and right, with negative for turning left and positive for turning right;

[0037] 2. Determine the positive and negative current steering angles of steering wheel 1 and steering wheel 2 in real time;

[0038] 3. The steering angle of steering wheel 2 is negative, steering wheel 2 is the reference wheel, and the algorithm is combined with A 2F Calculate and update the travel speed of four steering wheels in real time;

[0039] 4. The steering angles of steering wheel 1 and steering wheel 2 are zero, and the walking speed of the four steering wheels is updated in real time to V S ;

[0040] 5. The steering angle of steering wheel 1 is positive, steering wheel 1 is the reference wheel, and the algorithm is combined with A 1F Calculate and update the four steering wheel travel speeds in real time.

[0041] The present invention and its implementation methods are described above, and such description is not restrictive. What is shown in the specific implementation method is only one of the implementation methods of the present invention, and the actual structure is not limited thereto. In short, if ordinary technicians in this field are inspired by it, without departing from the purpose of the invention, they can design a structure and embodiment similar to the technical solution without creativity, which should belong to the protection scope of the present invention.

Claims

1. A control algorithm for a four-steering wheel chassis walking on a curve, characterized by: The utility model comprises a chassis, a programmable logic controller, four groups of steering wheels, a steering servo motor and a traveling servo motor. The four groups of steering wheels are symmetrically mounted on the chassis, and the first two of the four groups of steering wheels are steering steering wheels, and the last two are traveling steering wheels. The steering servo motor is connected to the steering steering wheels, and the traveling servo motor is connected to the traveling steering wheels.

2. A control algorithm for a four-steering wheel chassis walking on a curve, characterized by: Define the right front steering wheel as 1, the left front steering wheel as 2, the left rear steering wheel as 3, and the right rear steering wheel as 4. When turning right, adjust the angle A S and speed V S Assign value to steering wheel 1, i.e. A1 = A S 、V1=V S ,Other steering wheel angle and speed calculations are: Step 1: The turning radius R1 from the center of the circle to the steering wheel 1 is: Where L is the distance between steering wheel 2 and steering wheel 3; Step 2: The turning radius R4 from the center of the circle to the steering wheel 4 is: Step 3: The turning radius R2 from the center of the circle to the steering wheel 2 is: Where T is the distance between steering wheel 1 and steering wheel 2; Step 4, the turning radius R3 from the center of the circle to the steering wheel 3 is: R3 = R4 + T; Step 5, the angular velocity W of the chassis when walking in a curve is: Step 6, the turning angle A2 of steering wheel 2 is: Step 7, according to the relationship between linear velocity and angular velocity: V = WR, V2, V3, and V4 can be calculated; Step 8: When turning right, the steering wheel 3 and the steering wheel 4 do not turn, A3 = A4 = 0; Step 9: The rotation angles and travel speeds of the four steering wheels have been calculated. Similarly, when a left turn is required, the center of the circle is on the left side of the vehicle, the known rotation angle and speed are assigned to steering wheel 2, and the rotation angles and speeds of the remaining steering wheels are calculated according to the above calculation steps.

3. The control algorithm for curved walking of a four-steering wheel chassis according to claim 1 is characterized by: The steering servo motor adopts an absolute encoder. Regardless of whether the servo motor is powered or not, the encoder can record the current steering angle. When the steering servo motor and the programmable logic controller are powered on, the steering servo motor can feed back the position to the programmable logic controller in real time.

4. The control algorithm for curved walking of a four-steering wheel chassis according to claim 1 is characterized by: When the steering angle of the chassis is zero during movement, the chassis moves in a straight line. When the steering wheel at the front end of the given walking direction is at a certain steering angle, the chassis moves in a curve.

5. The control algorithm for curved walking of a four-steering wheel chassis according to claim 2 is characterized by: When the steering angle of the chassis is not zero during movement, the steering angle and walking speed of the steering wheel should be calculated separately according to the algorithm. S When the steering wheel is turned to A S Angle. Since the calculation of the walking speed is related to the distance from the center of the curve to each steering wheel, and the position of the center of the curve is related to the current angle of the steering wheel, the calculation of the walking speed should be based on the angle A fed back by the steering wheel in real time. F To calculate, before the steering angle reaches A S When in position, the walking speed is based on A F Changes in real time.

6. The control algorithm for curved walking of a four-steering wheel chassis according to claim 5 is characterized by: The feedback angle A F It is calculated through the real-time feedback encoding of the steering servo motor and the steering wheel (number of large and small gears, reduction ratio) parameters.

7. The control algorithm for curved walking of a four-steering wheel chassis according to claim 6 is characterized by: The coding of the steering servo motor is fed back in real time through industrial bus communication between the programmable logic controller and the servo driver, and the programmable logic controller reads the coding value of the servo motor in real time.