A device and control method for measuring the turning angle of driving wheels of a wheeled vehicle

By designing a wheeled vehicle active wheel angle measurement device in vehicle automatic assisted driving technology, using non-contact and single-sided absolute angle sensors, combined with neural network model, the problem of low vehicle steering control accuracy is solved, and high-precision Steering control and path tracking.

CN114543733BActive Publication Date: 2024-11-05JIANGSU UNIV
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
CN202210058511.3
Authority / Receiving Office
CN · China
Patent Type
Patents(China)
Current Assignee / Owner
Filing Date
2022-01-19
Publication Date
2024-11-05
Estimated Expiration
2042-01-19

AI Technical Summary

Technical Problem

In the existing automatic assisted driving technology of vehicles, the measurement accuracy of the active wheel angle is low, the data reading is complex, and the control algorithm is poorly adaptable. Especially in agricultural machinery, the mapping relationship between the wheel angle and the absolute position of the motor cannot be accurately obtained, resulting in poor steering control accuracy. high.

Method used

A wheeled vehicle active wheel angle measurement device is designed, including a portable mounting structure, measurement unit and control unit. It adopts a non-contact angle sensor and a single-side absolute angle sensor to generate a measurement model through calibration tests, and combines a neural network to achieve high quality. Accuracy steering control ensures the vehicle's path tracking accuracy during autonomous driving.

Benefits of technology

It realizes high-precision vehicle steering control, simplifies device installation and use, reduces costs, is suitable for multiple categories of vehicles, and improves the accuracy and stability of the steering control algorithm.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN114543733B_ABST
    Figure CN114543733B_ABST
Patent Text Reader

Abstract

The present invention provides a device and a control method for measuring the steering angle of the driving wheel of a wheeled vehicle. The device comprises a portable mounting structure, a measuring unit and a control unit. The portable mounting structure comprises a cylindrical sleeve, a stop screw, a connecting plate and a bolt. The measuring unit comprises a non-contact angle sensor, a single-sided absolute angle sensor and a power supply. The control unit comprises a DC motor and a controller. The controller comprises a main control panel and a display unit. During operation, the mapping relationship between the steering angle of the driving wheel and the single-sided absolute angle sensor is first generated by the measuring device. Then, the portable mounting structure and the non-contact angle sensor are disassembled. Finally, the real-time steering of the wheel is fed back through the angle information. The difference is taken from the target steering angle of the control method. The controller drives the DC motor for driving wheel steering angle control. The present invention can perform high-precision measurement of the steering angle in the vehicle steering control experiment, which is convenient for analyzing the experimental characteristics, improving the accuracy of the measuring unit, and optimizing the steering control algorithm.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The invention relates to the field of vehicle automatic assisted driving, in particular to the measurement and control of the steering angle of active wheels of wheeled vehicles, and is particularly suitable for agricultural machinery. Background Art

[0002] In the field of vehicle automatic assisted driving, the active wheel angle information in vehicle automatic navigation is important information in the navigation control algorithm. It is used as vehicle status information for feedback control. Accurate wheel angle information can directly improve the vehicle's automatic driving control accuracy and operation effect. However, the instruments currently used to measure the inner and outer wheel angles of vehicles are wheel aligners or wheel angle measurement turntables, and auxiliary devices are required to lift the wheels of the vehicle being tested for easy placement. The device cost is high, the labor cost is high, the angle measurement accuracy is low, and the data reading is complicated.

[0003] Currently, DC motors are widely used on the market, and the angle encoders in them are incremental. The detection accuracy is greatly affected by random drift, cumulative error and external interference. In addition, the control accuracy is greatly affected by factors such as the free travel of the vehicle steering system and the steering gear clearance. Especially for agricultural machinery, it is impossible to accurately obtain the mapping relationship between the wheel angle and the absolute position of the motor. The control algorithm in existing research uses a table lookup method, which is too idealistic and has major drawbacks and errors.

[0004] In the prior art, patent CN 112758177 A discloses a steering control method and steering control system based on the absolute position of the motor, which is only applicable to the control of wheel steering by completely relying on the table lookup method to realize the target wheel angle and the absolute motor angle, and indicates that recalibration is required and difficult to achieve for the purpose of vehicle maintenance or calibration, system upgrade, or after the software and hardware of the vehicle's steering control system change. The paper "Design of Steering Control System for Electric Steering Wheel Transplanter" (He Jie et al., Transactions of the Chinese Society of Agricultural Engineering, 2019, 35(06):10-17.) designed a PID nested steering control algorithm with a dead zone range, but it is only applicable to vehicles with high transmission mechanism installation accuracy and low wear rate, and has poor adaptability to different models. For low-speed wheeled vehicles, the kinematic model of two-wheeled vehicles is widely used. The high-precision measurement of the steering angle of the active wheel and the real-time feasible control method can effectively improve the accuracy of the steering control algorithm. Summary of the invention

[0005] In view of the deficiencies in the prior art, the main purpose of the present invention is to provide a device and a control method for measuring the driving wheel angle of a wheeled vehicle, so as to achieve high-precision data integration display, stable driving wheel steering angle solution, and high-precision vehicle steering control, thereby laying a foundation for high-precision path tracking during automatic driving operations.

[0006] The present invention achieves the above technical purpose through the following technical solutions: a wheeled vehicle driving wheel angle measuring device, including a portable installation structure, a measuring unit and a control unit, the portable installation structure includes a stop screw 2, a cylindrical sleeve 3, a bolt 4, a bolt 6 and a connecting plate 7, one end of the cylindrical sleeve 3 is fixed to the left and right wheel frame shafts 1 through the stop screw 2, and the other end is fixed to the connecting plate 7 through the bolt 4, and the non-contact angle sensor 5 of the measuring unit is fixed to the connecting plate 7 by the bolt 6; the measuring unit includes the left and right wheel non-contact angle sensors 5, the single-sided absolute angle sensor 9 and the power supply 11, and the control unit includes a DC motor 10 and a controller 1 4, the controller 14 includes a main control board 12 and a display unit 13; the non-contact angle sensor 5, the single-sided absolute angle sensor 9, the DC motor 10, and the display unit 13 are all connected to the main control board 12, the DC motor 10 is controlled to rotate by the main control board 12, the real-time data of the non-contact angle sensor 5, the single-sided absolute angle sensor 9 and the DC motor 10 are loaded and stored in the main control board 12 and numerically displayed on the display unit 13, the main control board 12 provides numerical storage and integrated control functions, the display unit 13 provides numerical display and human-computer interaction functions, and can input data to change related control parameters, and the power supply 11 supplies power to the power unit of the measuring device.

[0007] Furthermore, the portable mounting structure and the non-contact angle sensor 5 form a measuring subunit 8, which can be easily installed on the left and right driving wheels of the vehicle. For an Ackerman steering wheel vehicle, assuming that the wheels are all rolling in the steering process without slipping or sliding, the ideal condition is: Among them, α is the steering angle of the outer side of the driving wheel, β is the steering angle of the inner side of the driving wheel, B is the wheelbase, and L is the wheelbase of the front and rear wheels.

[0008] The control method of the driving wheel angle measuring device of a wheeled vehicle of the present invention comprises the following steps:

[0009] Step 1: Calibration test of the mapping relationship between the driving wheel steering angle and the single-side absolute angle sensor 9;

[0010] Step 2: dismantle the measuring subunit 8, determine the zero position deviation ε of the driving wheel steering angle by a straight-line driving test, and generate a measurement model;

[0011] Step 3: Completely rely on the measurement model in step 2 to join the control program and implement the control method.

[0012] Further, the step 1 specifically includes the following steps:

[0013] 1.1) Park the vehicle on a flat surface, install the measuring subunit 8, and make the bottom surface of the connecting plate 7 in the measuring subunit 8 parallel to the ground, so as to ensure the accurate measurement of the deflection angle of the non-contact angle sensor 5. The unilateral absolute angle sensor 9 is used to measure the unilateral steering angle. According to the different steering structures of wheeled vehicles, the installation position of the unilateral absolute angle sensor 9 is not uniform, and it is preferably installed on the main pin shaft of the vehicle. The carrier transplanter adopts a planar four-bar linkage mechanism to be installed on the right front wheel;

[0014] 1.2) Ensure that the driving wheel is theoretically in the neutral steering position, where the neutral position refers to the position where the actual wheel angle is 0 when the vehicle is driving in a straight line;

[0015] 1.3) The power unit is powered on, and the controller 14 obtains the driving wheel steering angle information and the unilateral steering angle information through the left and right wheel non-contact angle sensors 5 and the unilateral absolute angle sensor 9 respectively;

[0016] 1.4) Within the active steering limit range of the driving wheel, the controller 14 controls the DC motor 10 to rotate the steering wheel at small angles and intervals, thereby driving the wheels to rotate. The interval angle is recommended to be 10-30°. The left and right wheel steering angle information is displayed in real time on the controller 14 and stored in the SD card. The data is collected, and the left and right turning angle information of the vehicle is recorded with the middle position of the driving wheel as the boundary. The actual angle is equal to the deviation between the real-time steering angle and the middle angle, which are the left wheel left turn actual angle δ all 、The actual angle of the right wheel turning left δ arl , Actual angle of single-side left turn δ cl 、The actual angle of the left wheel turning right δ alr 、The actual right turn angle of the right wheel δ arr , Actual angle of single right turn δ cr , it is stipulated that the left deflection of the wheel is the positive direction;

[0017] 1.5) For the data collected in step 1.4), the control program uses a sliding average filter method to filter the data, and the median virtual wheel angle of the two-wheeled vehicle kinematic model is Where δ l is the left wheel steering angle, δ r is the right wheel steering angle, which is subdivided into the actual left turn angle of the median virtual wheel Actual right turn angle of the virtual wheel in the middle Anti-interference, least squares method linear processing data, multiple groups of experiments through the Q value detection method after the average state value, generate δ cl and δ al ,δ cr and δ ar The mapping relationships are: al =k l δcl +b l , δ ar =k r δ cr +b r , where k l , k r The slope of the indicator formula, b l , b r The intercept of the indicator formula, the angle deviation between the synthetic mapping relationship of the two rotation directions is recorded as the median virtual wheel tolerance error

[0018] Further, the step 2 specifically includes the following steps:

[0019] 2.1) Choose to drive in a straight line on a flat road and continuously sample to obtain N sets of test data;

[0020] 2.2) According to the Ackerman vehicle kinematic model: And the zero deviation identification performance optimization index function defined when driving in a straight line: When satisfied The F value can be minimized and ε can be obtained, where Refers to the vehicle heading angle at time t+1 and t, v t Refers to the vehicle speed at time t, where the vehicle heading angle and the speed are transmitted to the controller 14 by the host computer of the navigation control system, ΔT refers to the data sampling time interval, where the sampling time interval is selected as 100ms, and δ at refers to the virtual wheel steering angle of the vehicle at time t, i refers to the i-th group of test data, Refers to the vehicle body heading angle data of the i-th and i-1-th groups, v i-1 Refers to the i-1th group of vehicle speed data, δ a,i-1 Refers to the median virtual wheel steering angle data of the i-1th group of vehicles;

[0021] 2.3) Obtain zero position deviation ε and generate measurement model δ al =k l δ cl +b l -ε,δ ar =k r δ cr +b r -ε, Calculate the 9 degree δ of the single-sided absolute angle sensor when the driving wheel is in zero position c0 .

[0022] Further, the step three specifically includes the following steps:

[0023] 3.1) Obtain the initial single-sided absolute angle sensor 9 reading δ when the vehicle control system is powered onck , based on δ c0 The program can determine the initial relative direction of the wheels. When performing the vehicle straight line tracking or curve tracking process, the single-side absolute angle sensor 9 reading δ c The measurement model subroutine in the control program can generate the median virtual wheel angle δ in real time a ;

[0024] 3.2) The navigation control system provides the controller 14 with real-time lateral deviation, heading deviation, and vehicle speed, and uses a pure tracking model based on a neural network to output the median virtual wheel target turning angle δ u , calculate the current median virtual wheel real-time deviation Δδ = δ u -δ a , the current unilateral angle real-time deviation Δδ is converted through the measurement model subroutine c , determine the rotation direction of the driving wheel at the next moment according to the sign of the vector deviation;

[0025] 3.3) Considering that there is no accurate mapping relationship between the vehicle's driving wheel steering angle and the steering wheel steering motor angle in the free travel range, the next moment's rotation direction of the driving wheel determined in step 3.2) is calculated by the unilateral angle real-time deviation Δδ c The approximate angle Δδ that the DC motor 10 needs to rotate can be obtained d ;

[0026] 3.4) Set the tolerance error σ, where the tolerance error σ varies according to different vehicle models and transmission mechanism accuracy, and needs to be obtained through debugging experiments to ensure that the rotation angle of the DC motor 10 meets Δδ d -σ≤Δδ D ≤Δδ d +σ, select the response period of DC motor 10 as 200Hz to ensure the high-frequency response and real-time performance of the control system, and the stability and robustness of the vehicle. The corresponding sign changes in the control program, namely the vector information of the state quantity used, have both size and direction, and add the necessary flag bits to complete the active wheel steering control.

[0027] The non-contact angle sensor 5 is the LPMS-IG1 RS232 model produced by Guangzhou Alubi, with an angle resolution of 0.01°, an angle random walk (f=10Hz) of 0.18° / h, a zero position stability of 4° / h, and a waterproof grade of IP67. The sensor 5 is connected to the RS232 interface of the main control board through its own RS232 serial port.

[0028] The unilateral absolute angle sensor 9 is the DWQT-RS485-G / J model produced by Beijing Tianhai Technology. The sensor has two U-shaped fixing grooves and a mounting hole. It is installed on the steering shaft of the single-sided active wheel using a flat four-bar installation method (the carrier transplanter is installed on the right front wheel). This sensor uses a new magnetic sensitive element with a resolution of 0.022° and is connected to the RS485 interface of the main control board through its own RS485 serial port.

[0029] The DC motor 10 is of the AF300 model produced by Shanghai Lianshi Navigation Company. The DC motor 10 is installed on the fixed shaft of the steering wheel and fixed with a locking device. The installation method is shown in the patent (CN207450006U Beidou Navigation Automatic Driving Steering Wheel Device).

[0030] The main control board 12 uses the EMB8616I industrial control board and uses ST's STM32F107VCT6 as the MCU. The industrial control board integrates 3 RS232 serial ports, 1 RS485 serial port, 1 UART serial port, and 8 12-bit A / D conversion interfaces.

[0031] The display unit 13 is a DC10600M070_2111_0C capacitive touch screen produced by Guangzhou Dacai Optoelectronics Technology Co., Ltd. The touch screen is integrated with a TTL interface. The display unit 13 is connected to the UART interface of the controller via the TTL interface for displaying and setting real-time angle and other information.

[0032] The beneficial effects of the present invention are:

[0033] (1) The wheeled vehicle active wheel steering angle measurement device and control method of the present invention can measure and record the steering angle during the automatic steering control experiment, which is convenient for analyzing the vehicle steering control experiment characteristics, improving the steering angle measurement unit accuracy and improving the steering control algorithm accuracy.

[0034] (2) The measuring device of the present invention has simple installation and disassembly process, low cost, high use efficiency, strong practicality and wide application range.

[0035] (3) The control method of the present invention is applicable to vehicles whose free travel cannot be represented by an accurate model. The control algorithm has been tested on multiple types of vehicles and is real-time and feasible with high control accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0036] Figure 1 This is a schematic diagram of the driving wheel angle measurement subunit in the driving wheel angle measurement device and control method of the wheeled vehicle of the present invention.

[0037] Figure 2 The structure diagram of the driving wheel angle measuring device in the driving wheel angle measuring device and control method of the wheeled vehicle of the present invention is

[0038] Figure 3 This is a principle block diagram of the driving wheel angle control method in the wheeled vehicle driving wheel angle measurement device and control method of the present invention.

[0039] Among them: 1- paddy wheel (wheel); 2- stop screw; 3- cylindrical sleeve; 4- M5 bolt; 5- non-contact angle sensor; 6- M3 bolt; 7- connecting plate; 8- measuring subunit; 9- single-sided absolute angle sensor; 10- DC motor (electric steering wheel); 11- power supply; 12- main control board; 13- display unit; 14- controller DETAILED DESCRIPTION

[0040] The present invention is further described in detail below with reference to the accompanying drawings.

[0041] The present invention provides an automatic driving auxiliary measurement system, wherein the device for measuring the active wheel steering angle of a wheeled vehicle and the control method thereof comprise a portable installation structure, a measuring unit and a control unit.

[0042] The portable installation structure includes a cylindrical sleeve 3 and a connecting plate 7. One end of the cylindrical sleeve 3 is fixed to the left and right wheel frame shafts 1 by two stop screws 2, and the other end is fixed to the connecting plate 7 by two bolts 4. The non-contact angle sensor 5 of the measuring unit is fixed to the connecting plate 7 by four bolts 6.

[0043] The measuring unit comprises left and right wheel non-contact angle sensors 5 , a single-side absolute angle sensor 9 and a power supply 11 .

[0044] The non-contact angle sensor 5 is the LPMS-IG1 RS232 model produced by Guangzhou Alubi, with an angle resolution of 0.01°, an angle random walk (f=10Hz) of 0.18° / h, a zero position stability of 4° / h, and a waterproof grade of IP67. The sensor 5 is connected to the RS232 interface of the main control board through its own RS232 serial port.

[0045] The unilateral absolute angle sensor 9 is the DWQT-RS485-G / J model produced by Beijing Tianhai Technology. The sensor has two U-shaped fixing grooves and a mounting hole. It is installed on the steering shaft of the single-sided active wheel using a flat four-bar installation method (the carrier transplanter is installed on the right front wheel). This sensor uses a new magnetic sensitive element with a resolution of 0.022° and is connected to the RS485 interface of the main control board through its own RS485 serial port.

[0046] The control unit includes a DC motor 10 and a controller 14, and the controller 14 includes a main control board 12 and a display unit 13. The output end of the angle sensor is connected to the input end of the controller. The main control board 12 provides numerical storage and integrated control functions, and the display unit 13 provides numerical display and human-computer interaction functions. The power supply 11 supplies power to the power unit of the measuring device.

[0047] The DC motor 10 is of the AF300 model produced by Shanghai Lianshi Navigation Company. The DC motor 10 is installed on the fixed shaft of the steering wheel and fixed with a locking device. The installation method is shown in the patent (CN207450006U Beidou Navigation Automatic Driving Steering Wheel Device).

[0048] The main control board 12 uses the EMB8616I industrial control board and uses ST's STM32F107VCT6 as the MCU. The industrial control board integrates 3 RS232 serial ports, 1 RS485 serial port, 1 UART serial port, and 8 12-bit A / D conversion interfaces.

[0049] The display unit 13 is a DC10600M070_2111_0C capacitive touch screen produced by Guangzhou Dacai Optoelectronics Technology Co., Ltd. The touch screen is integrated with a TTL interface. The display unit 13 is connected to the UART interface of the controller via the TTL interface for displaying and setting real-time angle and other information.

[0050] The portable mounting structure is characterized in that the non-contact angle sensor 5 is fixedly connected to the portable mounting structure to form a measuring subunit 8, and the measuring subunit 8 can be simply installed on the left and right driving wheels of the vehicle. For an Ackerman steering wheel vehicle, it is assumed that the wheels are all pure rolling during the steering process without slipping or sliding. The ideal condition is as follows: Among them, α refers to the steering angle of the outer side of the driving wheel, β refers to the steering angle of the inner side of the driving wheel, B refers to the wheelbase (1.5m for the carrier transplanter), and L refers to the wheelbase of the front and rear wheels (1.04m).

[0051] The device and control method for measuring the driving wheel angle of a wheeled vehicle include the following steps:

[0052] Step 1: Calibration test of the mapping relationship between the driving wheel steering angle and the single-side absolute angle sensor 9;

[0053] 1) Park the vehicle on a flat surface, install the measuring subunit 8 in claim 2, and make the bottom surface of the connecting plate 7 in the measuring subunit 8 parallel to the ground, so as to ensure the accurate measurement of the deflection angle of the non-contact angle sensor 5, and the unilateral absolute angle sensor 9 is used to measure the unilateral steering angle. According to the different steering structures of the wheeled vehicles, the installation position of the unilateral absolute angle sensor 9 is not uniform, and it is preferably installed on the main pin shaft of the vehicle. The carrier transplanter adopts a planar four-bar linkage mechanism to be installed on the right front wheel;

[0054] 2) Ensure that the driving wheel is theoretically in the neutral steering position, where the neutral position refers to the position where the actual wheel angle is 0 when the vehicle is driving in a straight line;

[0055] 3) The power unit is powered on, and the controller 14 obtains the driving wheel steering angle information and the unilateral steering angle information through the left and right wheel non-contact angle sensors 5 and the unilateral absolute angle sensor 9 respectively;

[0056] 4) Within the active steering limit range of the driving wheel, the controller 14 controls the DC motor 10 to rotate the steering wheel at small angles and equal intervals, thereby driving the wheels to rotate. The interval angle is recommended to be 10-30°. The left and right wheel steering angle information is displayed in real time on the controller 14 and stored in the SD card. The data is collected, and the left and right turning angle information of the vehicle is recorded with the middle position of the driving wheel as the boundary. The actual angle is equal to the deviation between the real-time steering angle and the middle angle, which are the left wheel left turn actual angle δ all 、The actual angle of the right wheel turning left δ arl , Actual angle of single-side left turn δ cl 、The actual angle of the left wheel turning right δ alr 、The actual right turn angle of the right wheel δ arr , Actual angle of single right turn δ cr , it is stipulated that the left deflection of the wheel is the positive direction;

[0057] 5) For the data collected in step 4), the control program uses a sliding average filtering method to filter the data, and the median virtual wheel angle of the two-wheeled vehicle kinematic model is Where δ l is the left wheel steering angle, δ r is the right wheel steering angle, which is subdivided into the actual left turn angle of the median virtual wheel Actual right turn angle of the virtual wheel in the middle Anti-interference, least squares method linear processing data, multiple groups of experiments through the Q value detection method after the average state value, generate δ cl and δ al ,δ cr and δ ar The mapping relationships are: al =k l δ cl +bl , δ ar =k r δ cr +b r , where k l , k r The slope of the indicator formula, b l , b r The intercept of the indicator formula, the angle deviation between the synthetic mapping relationship of the two rotation directions is recorded as the median virtual wheel tolerance error

[0058] Step 2: dismantle the measuring subunit 8, determine the zero position deviation ε of the driving wheel steering angle by a straight-line driving test, and generate a measurement model;

[0059] 1) Choose to drive in a straight line on a flat road and continuously sample to obtain N sets of test data;

[0060] 2) According to the Ackerman vehicle kinematics model: And the zero deviation identification performance optimization index function defined when driving in a straight line: When satisfied The F value can be minimized and ε can be obtained, where Refers to the vehicle heading angle at time t+1 and t, v t Refers to the vehicle speed at time t, where the vehicle heading angle and the speed are transmitted to the controller 14 by the host computer of the navigation control system, ΔT refers to the data sampling time interval, where the sampling time interval is selected as 100ms, and δ at refers to the virtual wheel steering angle of the vehicle at time t, i refers to the i-th group of test data, Refers to the vehicle body heading angle data of the i-th and i-1-th groups, v i-1 Refers to the i-1th group of vehicle speed data, δ a,i-1 Refers to the median virtual wheel steering angle data of the i-1th group of vehicles;

[0061] 3) Obtain zero deviation ε and generate measurement model δ al =k l δ cl +b l -ε,δ ar =k r δ cr +b r -ε, Calculate the 9 degree δ of the single-sided absolute angle sensor when the driving wheel is in zero position c0 .

[0062] Step 3: Completely rely on the measurement model in step 2 to join the control program and implement the control method;

[0063] 1) Obtain the initial single-sided absolute angle sensor 9 reading δ when the vehicle control system is powered on ck , based on δ in claim 5 c0 The program can determine the initial relative direction of the wheels. When performing the vehicle straight line tracking or curve tracking process, the single-side absolute angle sensor 9 reading δ c The measurement model subroutine in the control program can generate the median virtual wheel angle δ in real time a ;

[0064] 2) The navigation control system provides the controller 14 with real-time lateral deviation, heading deviation, and vehicle speed, and uses a pure tracking model based on a neural network to output the median virtual wheel target turning angle δ u , calculate the current median virtual wheel real-time deviation Δδ = δ u -δ a , the current unilateral angle real-time deviation Δδ is converted through the measurement model subroutine c , determine the rotation direction of the driving wheel at the next moment according to the sign of the vector deviation;

[0065] 3) Considering that there is no accurate mapping relationship between the vehicle's driving wheel steering angle and the steering wheel steering motor angle in the free travel range, the next moment's rotation direction of the driving wheel determined in step 2) is determined by the unilateral angle real-time deviation Δδ c The approximate angle Δδ that the DC motor 10 needs to rotate can be obtained d ;

[0066] 4) Set the tolerance error σ, where the tolerance error σ varies according to different vehicle models and transmission mechanism accuracy, and needs to be obtained through debugging experiments to ensure that the rotation angle of the DC motor 10 meets Δδ d -σ≤Δδ D ≤Δδ d +σ, select the response period of DC motor 10 as 200Hz to ensure the high-frequency response and real-time performance of the control system, and the stability and robustness of the vehicle. The corresponding sign changes in the control program, namely the vector information of the state quantity used, have both size and direction, and add the necessary flag bits to complete the active wheel steering control.

[0067] Finally, it should be noted that the above embodiments are only used to illustrate the technical solutions of the present invention rather than to limit the present invention. Those skilled in the art should understand that various changes, modifications, substitutions and variations may be made to these embodiments without departing from the principles and purpose of the present invention. The scope of the present invention is defined by the claims and their equivalents.

Claims

1. A device for measuring the driving wheel angle of a wheeled vehicle, characterized in that: The invention comprises a portable mounting structure, a measuring unit and a control unit. The portable mounting structure comprises a set screw (2), a cylindrical sleeve (3), a bolt (4), a bolt (6) and a connecting plate (7). One end of the cylindrical sleeve (3) is fixed to the left and right wheel frame shafts (1) by a set screw (2), and the other end is fixed to the connecting plate (7) by a bolt (4). The non-contact angle sensor (5) of the measuring unit is fixed to the connecting plate (7) by a bolt (6); the measuring unit comprises the left and right wheel non-contact angle sensors (5), a single-side absolute angle sensor (9) and a power supply (11); the control unit comprises a DC motor (10) and a controller (14); the controller (14) comprises a main control board (1 2) and a display unit (13); the non-contact angle sensor (5), the single-sided absolute angle sensor (9), the DC motor (10), and the display unit (13) are all connected to the main control board (12); the DC motor (10) is controlled to rotate by the main control board (12); the real-time data of the non-contact angle sensor (5), the single-sided absolute angle sensor (9), and the DC motor (10) are loaded and stored in the main control board (12) and numerically displayed on the display unit (13); the main control board (12) provides numerical storage and integrated control functions; the display unit (13) provides numerical display and human-computer interaction functions, and can input data to change related control parameters; the power supply (11) supplies power to the power consumption unit of the measuring device.

2. A device for measuring the driving wheel angle of a wheeled vehicle according to claim 1, characterized in that: The portable mounting structure and the non-contact angle sensor (5) form a measuring subunit (8), which can be easily mounted on the left and right driving wheels of a vehicle. For an Ackerman steering wheel vehicle, assuming that the wheels are all in pure rolling during the steering process without slipping or sliding, the ideal condition is: Among them, α is the steering angle of the outer side of the driving wheel, β is the steering angle of the inner side of the driving wheel, B is the wheelbase, and L is the wheelbase of the front and rear wheels.

3. The control method of the driving wheel angle measuring device of a wheeled vehicle according to claim 2, characterized in that: The steps include: Step 1: Calibration test of the mapping relationship between the driving wheel steering angle and the single-side absolute angle sensor (9); Step 2: dismantle the measuring subunit (8), perform a straight-line driving test to determine the zero-position deviation ε of the driving wheel steering angle, and generate a measurement model; Step 3: Completely rely on the measurement model in step 2 to join the control program and implement the control method.

4. The control method of the device for measuring the driving wheel angle of a wheeled vehicle according to claim 3, characterized in that: The step 1 specifically includes the following steps: 1.1) Park the vehicle on a flat surface, install the measuring subunit (8), and make the bottom surface of the connecting plate (7) in the measuring subunit (8) parallel to the ground, so as to ensure the accurate measurement of the deflection angle of the non-contact angle sensor (5). The unilateral absolute angle sensor (9) is used to measure the unilateral steering angle. The installation position of the unilateral absolute angle sensor (9) is not uniform according to the different steering structures of the wheeled vehicle. It is preferably installed on the main pin shaft of the vehicle. The carrier transplanter adopts a planar four-bar linkage mechanism to be installed on the right front wheel. 1.2) Ensure that the driving wheel is theoretically in the neutral steering position, where the neutral position refers to the position where the actual wheel angle is 0 when the vehicle is traveling in a straight line; 1.3) The power unit is powered on, and the controller (14) obtains the driving wheel steering angle information and the unilateral steering angle information through the left and right wheel non-contact angle sensors (5) and the unilateral absolute angle sensor (9); 1.4) Within the active steering limit range of the driving wheel, the controller (14) controls the DC motor (10) to rotate the steering wheel at small angles and equal intervals, thereby driving the wheels to rotate. The interval angle is recommended to be 10 to 30 degrees. The left and right wheel steering angle information is displayed in real time on the controller (14) and stored in the SD card. The data is collected and the left and right steering angle information corresponding to the vehicle is recorded with the center position of the driving wheel as the boundary. The actual angle is equal to the deviation between the real-time steering angle and the center angle, which are the actual left turn angle δ of the left wheel, respectively. all , the actual angle of the right wheel turning left δ arl , Actual angle of unilateral left turn δ cl , Actual angle of left wheel turning right δ alr , the actual right turn angle of the right wheel δ arr , Actual angle of single-side right turn δ cr , it is stipulated that the left deflection of the wheel is the positive direction; 1.5) The data collected in step 1.4) are filtered using a sliding average filter method in the control program, and the median virtual wheel angle of the two-wheeled vehicle kinematic model is Where δ l is the left wheel steering angle, δ r is the right wheel steering angle, which is subdivided into the actual left turn angle of the median virtual wheel Actual right turn angle of the virtual wheel in the middle position Anti-interference, least squares linear processing data, multiple groups of experiments through the Q value detection method after the average state value is taken to generate δ cl and δ al , δ cr and δ ar The mapping relationships are: al =k l δ cl +b l , δ ar =k r δ cr +b r , where k l 、k r The slope of the indicator formula, b l 、b r The intercept of the indicator formula, the angular deviation between the synthetic mapping relationship of the two rotation directions is recorded as the median virtual wheel tolerance error 5. The control method of the driving wheel angle measuring device of a wheeled vehicle according to claim 3, characterized in that: The step 2 specifically includes the following steps: 2.1) Select a straight line driving on a flat road and continuously sample to obtain N sets of test data; 2.2) According to the Ackermann vehicle kinematic model: And the zero deviation identification performance optimization index function defined when driving in a straight line: When satisfied To minimize the F value, calculate ε, where Refers to the vehicle heading angle at time t+1 and t, v t Refers to the vehicle speed at time t, where the vehicle heading angle and speed are transmitted from the host computer of the navigation control system to the controller (14), ΔT refers to the data sampling time interval, where the sampling time interval is selected as 100ms, δ at Refers to the vehicle's median virtual wheel steering angle at time t, i refers to the i-th group of test data, Refers to the vehicle body heading angle data of the i-th and i-1-th groups, v i-1 Refers to the i-1th group of vehicle speed data, δ a,i-1 Refers to the median virtual wheel steering angle data of the i-1th group of vehicles; 2.3) Obtain zero deviation ε and generate measurement model δ al =k l δ cl +b l -ε,δ ar =k r δ cr +b r -ε, Calculate the degree δ of the single-side absolute angle sensor (9) when the driving wheel is in zero position c0 .

6. The control method of the device for measuring the driving wheel angle of a wheeled vehicle according to claim 5, characterized in that: The step three specifically includes the following steps: 3.1) Obtain the initial single-sided absolute angle sensor (9) reading δ when the vehicle control system is powered on ck , based on δ c0 The program can determine the initial relative direction of the wheels. When the vehicle is tracking a straight line or a curve, the single-side absolute angle sensor (9) reads δ c , the measurement model subroutine in the control program can generate the median virtual wheel angle δ in real time a ; 3.2) The navigation control system provides the controller (14) with real-time lateral deviation, heading deviation, and vehicle speed, and uses a pure tracking model based on a neural network to output the median virtual wheel target angle δ u , calculate the current moment's median virtual wheel real-time deviation Δδ = δ u -δ a , calculate the current unilateral angle real-time deviation Δδ through the measurement model subroutine c , determine the next rotation direction of the driving wheel according to the sign of the vector deviation; 3.3) Considering that there is no accurate mapping relationship between the vehicle's driving wheel steering angle and the steering wheel steering motor angle in the free travel range, the next moment's rotation direction of the driving wheel determined in step 3.2) is determined by the unilateral angle real-time deviation Δδ c The angle Δδ that the DC motor (10) needs to rotate can be obtained d ; 3.4) Set the tolerance error σ, where the tolerance error σ varies according to different vehicle models and transmission mechanism accuracy, and needs to be obtained through debugging experiments to ensure that the rotation angle of the DC motor (10) meets Δδ d -σ≤Δδ D ≤Δδ d +σ, the response period of the DC motor (10) is selected as 200Hz to ensure the high frequency response and real-time performance of the control system, and the stability and robustness of the vehicle. The corresponding symbol changes in the control program are the vector information of the state quantity used, which has both size and direction, and a flag is added to complete the active wheel steering control.