A method and device for evaluating the traction of a wheel hook in soft terrain
By simplifying the concepts of equivalent radius and entry angle, and combining capacitive proximity switches and six-dimensional force sensors, the hook traction force of the wheel spike is calculated, solving the problems of high solution cost and many parameters in the existing technology, and realizing efficient and accurate measurement.
Patent Information
- Application Number
- CN202311274190.1
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2023-09-28
- Publication Date
- 2024-11-15
- Estimated Expiration
- 2043-09-28
AI Technical Summary
Existing ground mechanics models for wheeled planetary vehicles suffer from high cost, low efficiency, numerous parameters, and difficulty in direct measurement.
By employing simplified concepts of equivalent radius and entry angle, combined with capacitive proximity switches and six-dimensional force sensors, and through simulating a smooth wheel model and a unified mechanical model of longitudinal slip and rotation, the hook traction force of the wheel spike is calculated.
The measurement process of the wheel-blade ground contact mechanical model was simplified, the measurement accuracy and calculation efficiency were improved, the dependence on complex mechanical structures was reduced, and the measurement error was reduced.
Smart Images

Figure CN117236052B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the technical field of soil mechanics, and in particular to a method and a device for evaluating the traction force of a wheel hook in soft terrain. Background Art
[0002] The study of the ground mechanics model of the contact between planetary wheels and the planetary surface soil is an important basis for the structural design, sensor system development and control algorithm design of the planetary rover.
[0003] Since the soil on the surface of planets such as Mars is soft, with low shear strength and compressive stiffness, it is very easy to cause the driving wheels to slip and sink. Therefore, planetary rovers often use spur wheels, which can greatly improve the traction function of the wheels in soft terrain. On this basis, it is of great significance to establish an accurate and not too complicated mathematical model of ground mechanics, so as to efficiently solve the relevant parameters of the contact between the planetary rover wheels and the planetary surface soil for the real-time motion control of the planetary rover.
[0004] The traditional planetary wheel-soil ground mechanics model is based on the Bekker normal stress formula and the Janosi shear stress formula. However, both the Bekker normal stress and the Janosi shear stress formula are exponential functions of the wheel-soil contact angle. The planetary vehicle ground mechanics model based on them is a complex set of highly coupled integral equations, which is costly to solve and inefficient. In addition, the existing unified mechanics model of longitudinal slip and rotation solves these problems well, but it is based on the research results of light wheels, and further research is needed on wheel-spur wheels. In the existing model, there are still many parameters to be solved and the parameters cannot be directly measured. Summary of the invention
[0005] The technical problems to be solved by the present invention are:
[0006] In order to solve the problems of high cost and low efficiency in solving the existing ground mechanics model of wheel-spur wheel planetary rover, many parameters and difficulty in direct measurement.
[0007] The present invention adopts the following technical solutions to solve the above technical problems:
[0008] The present invention provides a method for evaluating the traction of a wheel hook in soft terrain, comprising the following steps:
[0009] Step S100, ignoring the small range stress fluctuation of the wheel thorn part, simulating the change trend of the stress distribution curve in the light wheel model, assuming that the stress distribution acts on r and r+h G The equivalent radius r e Based on the unified mechanical model of the wheel-ground action of the light wheel, we can obtain:
[0010]
[0011]
[0012]
[0013]
[0014]
[0015] In the formula, h G is the wheel spur height; is the function of the wheel equivalent settlement with respect to the wheel-soil equivalent contact angle; S is the conversion function with respect to the wheel torque; F DP is the traction force; F N For support force; T D is the wheel driving torque; r e is the equivalent radius of the wheel; z e is the equivalent subsidence; θ 1e is the equivalent entry angle; θ 2E is the equivalent departure angle; τ and σ are the actual forces on the wheel; τ e , σ e K is the equivalent force on the wheel; σ and K τ are all equivalent mechanical parameters defined in the unified mechanical model; b is the wheel width; k is the wheel width; 1e , k 2e and k 3e is the coefficient for calculating wheel-soil contact force;
[0016] According to the quasi-static analysis and the above formula, T D , as follows:
[0017]
[0018] Among them, d is the lever arm of the hook traction force; e is the lever arm of the supporting force; c V and c D are coefficients related to the position of the equivalent action point, which can be obtained from θ 1e The linear representation of is as follows:
[0019]
[0020]
[0021] Step S200, using 32 capacitive proximity switches arranged circumferentially on the wheel and a six-dimensional force sensor inside the wheel to obtain the entry angle θ1, and then calculate the equivalent entry angle θ 1e , combined with the support force F N , driving torque T D and the equivalent action radius r e, the hook traction force F is calculated DP .
[0022] Furthermore, in step S200, it specifically includes:
[0023] Step S210, using a level to align the X+ direction of the six-dimensional force sensor's own coordinate system with the X+ direction of the world coordinate system, obtaining the 0 angle position, and sequentially numbering the 32 capacitive proximity switches;
[0024] Step S220: transmit the support force F collected by the six-dimensional force sensor through the data of the six-dimensional force sensor. N , driving torque T D and angle data, obtain the proximity switch number at the lowest bit according to the angle value obtained by the angle sensor, and calculate the entry angle θ1 and the departure angle θ2 according to the proximity switch data at this moment;
[0025] Step S230: Calculate the angle θ1 obtained in step S220 using the following formula to obtain θ 1e ;
[0026] The c calculated using the entry angle θ1 V and c D Substitute the following formula to calculate the estimated value of the wheel spur effect coefficient
[0027]
[0028] The calculated wheel-spur effect coefficient estimate Replace the wheel spur effect coefficient λ in the following formula G , calculate r e ,Right now,
[0029]
[0030] r e Substituting into the following formula, we can calculate θ 1e :
[0031]
[0032] Step S240: the support force F N , driving torque T D , equivalent action radius r e and the equivalent entry angle θ calculated in step S230 1e Substituting into the following formula, the hook traction force F can be calculated. DP ,
[0033]
[0034] Furthermore, in step S210, it specifically includes:
[0035] Step S211, using a level to measure the proximity switch number corresponding to the X+ direction of the six-dimensional force sensor's own coordinate system, setting the horizontal direction of the vehicle body forward as the X axis, the forward direction as the positive direction, and when the X+ of the six-dimensional force sensor coincides with the X+ of the world coordinate system, it is set as the 0 angle position;
[0036] Step S212, when the wheel rotates, the angle sensor integrated with the six-dimensional force sensor can output the absolute angle α in the X+ direction of the six-dimensional force sensor's own coordinate system, that is, one counterclockwise rotation increases from 0° to 360°, and the vertical downward angle is 270°. The proximity switch number corresponding to the vertical direction can be calculated based on the internal proximity switch number.
[0037] Furthermore, the actual output of the angle sensor is a voltage value. When it is actually used, the upper computer program is required to convert the voltage value into a radian value, and the real-time collection of the angle value and the numbering sequence of the internal proximity switch are used to determine the angle relationship between the sensor X+ and the corresponding proximity switch number.
[0038] Furthermore, an interpolation algorithm is used to perform error optimization to reduce the contact angle detection error.
[0039] Furthermore, in step S240, the support force F N The driving torque T can be obtained by static analysis of the vehicle. D It can be obtained by detecting the motor current according to the relationship curve between the motor current and the motor torque.
[0040] Furthermore, in practical applications, it is only necessary to use a proximity switch to measure the entry angle θ1.
[0041] A device for evaluating the traction of a wheel hook in soft terrain, comprising a plurality of capacitive proximity switches arranged on the wheel and a six-dimensional force sensor arranged in the wheel, wherein the capacitive proximity switches are evenly arranged around the wheel, and when an object is detected approaching, the output signal will be changed, and the contact angle can be determined according to the number of proximity switches in contact with the wheel and the soil; an angle sensor is arranged in the six-dimensional force sensor, and the six-dimensional force sensor is connected to a data acquisition card on the vehicle body for power supply and data through a slip ring;
[0042] It also includes a step-down PCB board, a microcontroller, a data transmission device, a host computer and a data acquisition card, which are used to transmit the wheel-soil contact data collected by 32 capacitive proximity switches to the host computer through the data transmission device carried by the microcontroller, and to transmit the support force F collected by the six-dimensional force sensor to the host computer. N , driving torque T DThe angle data are transmitted to the data acquisition card and the host computer in turn, and the host computer processes and calculates the entry angle θ1 and the departure angle θ2.
[0043] Furthermore, the number of the capacitive proximity switches may be 32, and the data of the capacitive proximity switches is represented by a string of 0s and 1s, where 1 indicates that the proximity switch is in contact with the terrain, and 0 indicates that the proximity switch is not in contact with the terrain.
[0044] A computer-readable storage medium stores a computer program, wherein the computer program is configured to implement the steps of a method for evaluating wheel spur wheel hook traction in soft terrain when called by a processor.
[0045] Compared with the prior art, the present invention has the following beneficial effects:
[0046] The present invention provides a method and device for evaluating the traction of a wheel hook in soft terrain, ignoring the stress fluctuation of the wheel hook part, assuming that the stress distribution is between r and r+h due to the wheel hook effect. G The equivalent radius r e The concept of stress equivalent radius is simplified, and the model of this method is obtained according to the unified mechanical model of the wheel-ground action of the light wheel. The entry angle θ1 is obtained by using the capacitive proximity switch and the six-dimensional force sensor, and the equivalent entry angle θ is obtained by calculation. 1e and the equivalent action radius r e , combined with the support force F N and driving torque T D Substituting into the model formula of this method, the hook traction force F is finally calculated. DP ;
[0047] The present invention discloses a method and device for evaluating the traction of a wheel hook in soft terrain, using proximity switches distributed around the wheel to measure the contact angle between the wheel and the soil, and using an angle sensor in combination to further solve the values of the approach angle and the departure angle, and the measurement and calculation process is simple, and does not require complex mechanical structures and equipment;
[0048] The present invention discloses a method and device for evaluating the traction force of a wheel hook in soft terrain, which has high measurement accuracy. Compared with measurement methods such as vision and absolute displacement sensors, the measurement process is not affected by factors such as virtual displacement caused by illumination and bulldozing effect.
[0049] The present invention provides a method and device for evaluating the traction of a wheel hook in soft terrain. The existing unified mechanical model of longitudinal slip and rotation is used to greatly simplify the wheel hook ground contact mechanical model. At the same time, the data processing of the measurement results of the entry angle only involves interpolation optimization, so it has a higher calculation speed. BRIEF DESCRIPTION OF THE DRAWINGS
[0050] Figure 1 It is a flow chart of a method for evaluating the traction force of a wheel hook in soft terrain according to an embodiment of the present invention;
[0051] Figure 2 It is a simplified schematic diagram of the force on the wheel of the wheel spur in the embodiment of the present invention;
[0052] Figure 3 This is a schematic diagram of the entry angle measurement principle in an embodiment of the present invention;
[0053] Figure 4 This is a schematic diagram of data transmission principle of a measuring device in an embodiment of the present invention;
[0054] Figure 5 The curves of the approach angle, the departure angle and the amount of subsidence calculated using the sampling data of the measuring device in the embodiment of the present invention over time are shown;
[0055] Figure 6 The curves of the approach angle, the departure angle and the amount of subsidence changing with time obtained by interpolating the sampling data of the measuring device in the embodiment of the present invention;
[0056] Figure 7 A comparison diagram of the traction force change with the slip rate when the measured value and the estimated value of W are 80N and 320N in an embodiment of the present invention;
[0057] Figure 8 The curve of the relative error of the hook traction force estimated by the method with W of 80N and 320N changing with the slip rate in the embodiment of the present invention;
[0058] Fig. 9 The curves showing the variation of equivalent soil mechanical parameters with slip rate when W is 80N and 320N in the embodiments of the present invention;
[0059] Fig.10 A physical device for evaluating the traction of a wheel hook in soft terrain according to an embodiment of the present invention Figure 1 ;
[0060] Fig.11 A physical device for evaluating the traction of a wheel hook in soft terrain according to an embodiment of the present invention Figure 2 ;
[0061] Figure 1 Medium, F DP is the traction force; W is the vertical load of the wheel; F N For support force; T D is the wheel driving torque; F R is the resistance; ω is the angular velocity of the wheel; v is the running speed; r is the radius of the wheel; r e is the equivalent radius of the wheel; z1 is the amount of light wheel sinking; z eis the equivalent subsidence; Δz G is the difference between the equivalent subsidence and the light wheel subsidence; θ1 is the entry angle; θ 1e is the equivalent entrance angle; θ2 is the departure angle; θ 2e is the equivalent departure angle; e and d are the force arms of the equivalent action point relative to the center of the wheel axis; τ and σ are the actual forces on the wheel, which are the shear stress and normal stress of the wheel-ground contact respectively; τ e , σ e The equivalent force on the wheel spur. DETAILED DESCRIPTION
[0062] In the description of the present invention, it should be noted that the terminology nouns in the various embodiments, such as "up", "down", "front", "back", "left", "right", etc., which indicate directions, are only for simplifying the description of the positional relationship based on the drawings in the specification, and do not mean that the referred elements and devices must be operated according to the specific directions and defined operations and methods and structures in the specification. Such directional nouns do not constitute a limitation on the present invention.
[0063] In order to make the above-mentioned objects, features and advantages of the present invention more obvious and easy to understand, specific embodiments of the present invention are described in detail below with reference to the accompanying drawings.
[0064] Specific implementation plan 1: Combine Figures 1 to 4 As shown, the present invention provides a method for evaluating the traction of a wheel hook in soft terrain, comprising the following steps:
[0065] Step S100, ignoring the small range stress fluctuation of the wheel thorn part, simulating the change trend of the stress distribution curve in the light wheel model, assuming that the stress distribution acts on r and r+h G The equivalent radius r e The stress acting on the equivalent radius is denoted as σ e and τ e , correspondingly consider the entry angle θ at the equivalent radius 1e According to the unified mechanical model of the wheel-ground interaction of the light wheel, we can obtain:
[0066]
[0067]
[0068]
[0069]
[0070]
[0071] In the formula, h Gis the wheel spur height; is the function of the wheel equivalent settlement with respect to the wheel-soil equivalent contact angle; S is the conversion function with respect to the wheel torque; F DP is the traction force; F N For support force; T D is the wheel driving torque; r e is the equivalent radius of the wheel; z e is the equivalent subsidence; θ 1e is the equivalent entry angle; θ 2e is the equivalent departure angle; is the actual force on the wheel; τ e , σ e K is the equivalent force on the wheel; σ and K τ are all equivalent mechanical parameters defined in the unified mechanical model; b is the wheel width; k is the wheel width; 1e , k 2e and k 3e is the coefficient for calculating wheel-soil contact force;
[0072] Combination Figure 2 As shown, according to Figure 2 The quasi-static analysis and the above formula can be used to obtain T D , as follows:
[0073]
[0074] Among them, e and d are Figure 2 The equivalent force point support force and the lever arm of the hook traction force; c V and c D are coefficients related to the position of the equivalent action point, which can be obtained from θ 1e The linear representation of is as follows:
[0075]
[0076]
[0077] Step S200, using 32 capacitive proximity switches arranged circumferentially on the wheel and a six-dimensional force sensor inside the wheel to obtain the entry angle θ1, and then calculate the equivalent entry angle θ 1e , combined with the calculated support force F N , driving torque and equivalent action radius r e , calculate the hook traction force F DP ,
[0078] Specifically, step S210, using a level to align the X+ direction of the six-dimensional force sensor's own coordinate system with the X+ direction of the world coordinate system, obtaining a 0 angle position, and sequentially numbering 32 capacitive proximity switches;
[0079] Step S211, using a level to measure the proximity switch number corresponding to the X+ direction of the six-dimensional force sensor's own coordinate system, setting the horizontal direction of the vehicle body forward as the X axis, the forward direction as the positive direction, and when the X+ of the six-dimensional force sensor coincides with the X+ of the world coordinate system, it is set as the 0 angle position;
[0080] Step S212, when the wheel rotates, the angle sensor integrated with the six-dimensional force sensor can output the absolute angle α in the X+ direction of the six-dimensional force sensor's own coordinate system, that is, one counterclockwise rotation increases from 0° to 360°, and the vertical downward angle is 270°. The proximity switch number corresponding to the vertical direction can be calculated according to the internal proximity switch number;
[0081] It should be noted that the actual output of the angle sensor is a voltage value. When actually used, the upper computer program needs to be used to convert the voltage value into a radian value. The angle relationship between the sensor X+ and the corresponding proximity switch number can be determined by using the real-time acquisition of the angle value and the numbering sequence of the internal proximity switch.
[0082] It should be noted that since the resolution of the proximity switch is 11.25°, the maximum error is about 19°; the interpolation algorithm is used for error optimization. The principle is to interpolate where the proximity switch number changes, so that when the wheel spur enters and exits the terrain, the acquired proximity switch changes become smooth, which greatly reduces the contact angle detection error;
[0083] Step S220: transmit the support force F collected by the six-dimensional force sensor through the data of the six-dimensional force sensor. N , driving torque T D and angle data, obtain the proximity switch number at the lowest bit according to the angle value obtained by the angle sensor, and calculate the entry angle θ1 and the departure angle θ2 according to the proximity switch data at this moment;
[0084] Specifically, the wheel-soil contact data is transmitted to the host computer by the Wifi module equipped with the microcontroller STM32F103, and the acquisition frequency is 50Hz; multi-threading is used to perform multiple groups of TCP / IP communications to realize data transmission between the host computer and multiple six-dimensional force sensors. The support force F collected by the six-dimensional force sensor N , driving torque T D The angle data is collected by the data acquisition module M8127 at a frequency of 50Hz and transmitted to the host computer via the network cable using the TCP / IP protocol. After the host computer program completes data verification, force coordinate system conversion, angle calculation, and timestamp acquisition, it is transferred to a file; the host computer program uses multi-threading to receive data and converts the support force F N , driving torque T D, the absolute angle of rotation at the sampling interval, the proximity switch signal and the timestamp are saved together and share the same timestamp to facilitate subsequent data processing; the proximity switch number at the lowest bit is obtained according to the angle value obtained by the angle sensor, and the entry angle and departure angle are calculated according to the proximity switch data at this moment, and the data within a period of time is interpolated and optimized to reduce the error and obtain the accurate entry angle θ1 and departure angle θ2;
[0085] Step S230: Calculate the angle θ1 obtained in step S220 using the following formula to obtain θ 1e ;
[0086] The specific process is: use the c calculated by the entry angle θ1 V and c D Substitute the following formula to calculate the estimated value of the wheel spur effect coefficient:
[0087]
[0088] In the formula, h G is the wheel spur height;
[0089] The calculated wheel-spur effect coefficient estimate Replace the wheel spur effect coefficient λ in the following formula G , calculate r e ,Right now,
[0090]
[0091] r e Substituting into the following formula, we can calculate θ 1e :
[0092]
[0093] Step S240: the support force F N , driving torque T D , equivalent action radius r e and the equivalent entry angle θ calculated in step S230 1e Substituting into the following formula, the hook traction force F can be calculated. DP ,
[0094]
[0095] Among them, the support force F N The driving torque T can be obtained by static analysis of the vehicle. D It can be obtained by detecting the motor current based on the relationship curve between the motor current and the motor torque.
[0096] It should be noted that, in practical applications, since the departure angle θ2 is usually very small and can be ignored, it is only necessary to use a proximity switch to measure the entry angle θ1.
[0097] In step S100, Figure 2 As shown in the figure, the normal stress σ and shear stress τ of the sand and the wheel are respectively Figure 2 In the figure, the solid line shows that in addition to converting the friction between the wheel and the ground into the internal friction of the soil, the wheel spurs have an additional supporting effect during the movement. However, the influence of the wheel spurs on the normal stress σ and the shear stress τ is difficult to express with a formula based on the current theory. Considering that the protrusion range of the additional stress generated by the wheel spurs during the movement is very small, the influence on the normal stress σ and the shear stress τ of the wheel-ground contact can be ignored. Therefore, the small-range stress fluctuation of the wheel spur part is averaged over the entire contact area to simulate the change trend of the stress distribution curve in the light wheel model. The stress amplitude change of the wheel spur wheel of the present application is quite different from that of the light wheel, τ e , σ e is the equivalent force on the wheel, that is Figure 2 The dotted line in .
[0098] Specific implementation plan 2: Combined Figure 3 , Fig.10 and Fig.11 As shown, the present invention provides a device for evaluating the traction of a wheel hook in soft terrain, comprising 32 capacitive proximity switches arranged on the wheel and a six-dimensional force sensor arranged in the wheel, wherein the capacitive proximity switches are evenly arranged around the wheel, and when an object is detected approaching, the output signal will be changed, and the contact angle can be judged according to the number of proximity switches in contact with the wheel and soil; an angle sensor is arranged in the six-dimensional force sensor, and the six-dimensional force sensor is connected to a data acquisition card on the vehicle body for power supply and data through a slip ring;
[0099] It also includes a step-down PCB board, a microcontroller, a data transmission device, a host computer and a data acquisition card, which are used to transmit the wheel-soil contact data collected by 32 capacitive proximity switches to the host computer through the Wifi module carried by the microcontroller STM32F103, and transmit the support force F collected by the six-dimensional force sensor to the host computer. N , driving torque T D The angle data are transmitted to the data acquisition card and the host computer in turn, and the host computer processes and calculates the entry angle θ1 and the departure angle θ2.
[0100] The other combinations and connection relationships of this embodiment are the same as those of the first embodiment.
[0101] Preferably, the data of the 32 capacitive proximity switches are represented by a character string consisting of "0" and "1", where "1" indicates that the proximity switch is in contact with the terrain, and "0" indicates that it is not in contact.
[0102] The present invention proposes the concepts of equivalent action radius and equivalent entry angle, obtains a unified mechanical model considering the wheel thorn effect based on the unified mechanical model of longitudinal sliding of the light wheel, and V 、c D and θ 1e The linear relationship between them greatly simplifies the mechanical model. A device for measuring the entry angle containing a proximity switch and an angle sensor is designed, which has the advantages of simple measurement and accurate and effective. 1e 、r e 、F N and T D The hook traction force F can be calculated DP Compared with the existing method for calculating the hook traction force, the method theoretically requires fewer parameters to be calculated, has higher solution efficiency and better real-time performance.
[0103] Combination Figures 5 to 8 It can be seen that Figure 5 The curves of approach angle, departure angle and wheel settlement over time calculated based on the collected proximity switch data and six-dimensional force sensor data when the wheel moves with a slip rate of 1 on simulated Martian soil. Figure 6 The curves of approach angle, departure angle and wheel settlement changing with time are obtained by interpolating the experimental data using the interpolation algorithm. Figure 5 and Figure 6 It can be proved that the measuring device and interpolation algorithm proposed in this application can measure the approach angle and departure angle of the wheel spur. Loads of 80N and 320N are applied to the wheel spur respectively, the slip rate increases from -0.6 to 0.6 in steps of 0.1, and the forward speed v=5mm / s. At the same time, the traditional method (linear displacement sensor) and this measuring device are used to measure the sinking amount and approach angle of the wheel spur during driving. The six-dimensional force sensor is used to measure the force and torque during the movement. The stable operation segment data in the experimental data is selected to obtain the average value. The average approach angle calculated under each slip rate and the average force and torque measured by the six-dimensional force sensor are substituted into the model of this method to evaluate the hook traction. Figure 7 The comparison curve between the estimated hook traction force and the measured hook traction force under each slip rate is shown in Figure 2. The average value of the calculated sinking amount under each slip rate and the average value of the force and torque measured by the six-dimensional force sensor are substituted into the light wheel unified model as the original method for comparison. The maximum hook traction force in the experimental data is used as a reference to calculate the relative error of the hook traction force. Figure 8 Relative error of the hook pulling force estimated by the original method and the existing method. Figure 7 and Figure 8 It is proved that this method can estimate the hook traction force well. Compared with the original method, this method can reduce the estimation error of the hook traction force. At the same time, the measurement device of this method is simpler and the measurement accuracy is higher. Fig. 9In order to evaluate the variation trend of equivalent mechanical parameters with slip rate using this method, when the load is 80N and 320N, both equivalent mechanical parameters change continuously with slip rate without sudden change, which proves the correctness of the wheel-spur wheel-soil contact mechanical model proposed in this method. The specific experimental data are shown in Tables 1 and 2 below.
[0104] Table 1, Experimental data of the change of slip rate when W is 80N
[0105]
[0106]
[0107] Table 2, Experimental data of the change of slip rate when W is 320N
[0108] Slip rate Support Subsidence Traction Driving torque Entry angle -0.6 318.29414 29.66136 -150.58348 -7.62005 33.8658122 -0.5 320.07566 22.73738 -124.02898 -4.82153 29.54737299 -0.4 328.16923 16.42378 -99.13766 -2.65193 25.03352318 -0.3 324.22915 11.50744 -75.15977 -0.88653 20.90384781 -0.2 326.76611 8.72816 -46.70086 0.7224 18.18069131 -0.1 321.89659 9.25225 -19.75496 5.05835 18.72333905 0 320.06614 13.51888 8.12377 11.43795 22.67957279 0.1 320.12678 17.8394 21.87528 16.38315 27.54771448 0.2 317.07234 23.47687 22.07766 18.04578 31.70138455 0.3 324.9334 30.68334 22.73076 20.9901 36.38979992 0.4 318.88998 34.92783 29.46709 22.45115 38.91993669 0.5 324.49932 40.7807 31.70513 24.12951 42.197996 0.6 318.20437 50.98458 34.1001 25.97084 47.46971716
[0109] Although the present invention is disclosed as above, the protection scope of the present invention is not limited thereto. Those skilled in the art may make various changes and modifications without departing from the spirit and scope of the present invention, and these changes and modifications will fall within the protection scope of the present invention.
Claims
1. A method for evaluating the traction of a wheel hook in soft terrain, characterized in that: The following steps are involved: The device for evaluating the traction of the wheel hook comprises a plurality of capacitive proximity switches arranged on the wheel and a six-dimensional force sensor arranged in the wheel. The capacitive proximity switches are evenly arranged around the wheel. When an object is detected approaching, the output signal will be changed. The contact angle can be determined according to the number of proximity switches in contact with the wheel and the soil. An angle sensor is arranged in the six-dimensional force sensor. The six-dimensional force sensor is connected to the data acquisition card on the vehicle body for power supply and data through a slip ring. It also includes a step-down PCB board, a microcontroller, a data transmission device, a host computer and a data acquisition card, which are used to transmit the wheel-soil contact data collected by 32 capacitive proximity switches to the host computer through the data transmission device carried by the microcontroller, and to transmit the support force F collected by the six-dimensional force sensor to the host computer. N , driving torque T D The angle data are transmitted to the data acquisition card and the host computer in turn, and the host computer processes and calculates the entry angle θ1 and the departure angle θ2; Step S100, ignoring the small range stress fluctuation of the wheel thorn part, simulating the change trend of the stress distribution curve in the light wheel model, assuming that the stress distribution acts on r and r+h G On the equivalent radius re, according to the unified mechanical model of the wheel-ground action of the light wheel, we can obtain: In the formula, h G is the wheel spur height; e (θ e ) is the function of the wheel equivalent settlement with respect to the wheel-soil equivalent contact angle; S is the conversion function with respect to the wheel torque; F DP is the traction force; F N For support; T D is the wheel driving torque; r e is the equivalent radius of the wheel; z e is the equivalent subsidence; θ 1e is the equivalent entry angle; θ 2r is the equivalent departure angle; τ and σ are the actual forces on the wheel; τ e , σ e K is the equivalent force on the wheel; σ and K τ are all equivalent mechanical parameters defined in the unified mechanical model; b is the wheel width; k is the wheel width; 1e , k 2e and k 3e To calculate the coefficient of wheel-soil contact force; According to the quasi-static analysis and the above formula, T D , as follows: Among them, d is the lever arm of the hook traction force; e is the lever arm of the supporting force; c V and c D are coefficients related to the position of the equivalent action point, which can be obtained from θ 1e The linear representation of is as follows: Step S200, using 32 capacitive proximity switches arranged circumferentially on the wheel and a six-dimensional force sensor inside the wheel to obtain the entry angle θ1, and then calculate the equivalent entry angle θ 1e , combined with the support force F N , driving torque T D and the equivalent action radius r e , the hook traction force F is calculated DP ,include, Step S210, using a level to align the X+ direction of the six-dimensional force sensor's own coordinate system with the X+ direction of the world coordinate system, obtaining the 0 angle position, and sequentially numbering the 32 capacitive proximity switches; Step S220: transmit the support force F collected by the six-dimensional force sensor through the data of the six-dimensional force sensor. N , driving torque T D and angle data, obtain the proximity switch number at the lowest bit according to the angle value obtained by the angle sensor, and calculate the entry angle θ1 and the departure angle θ2 according to the proximity switch data at this moment; Step S230: Calculate the angle θ1 obtained in step S220 using the following formula to obtain θ 1e ; The c calculated using the entry angle θ1 V and c D Substitute the following formula to calculate the estimated value of the wheel spur effect coefficient The calculated wheel-spur effect coefficient estimate Replace the wheel spur effect coefficient λ in the following formula G , calculate r e ,Right now, r e Substituting into the following formula, we can calculate θ 1e : Step S240: the support force F N , driving torque T D , equivalent action radius r e and the equivalent entry angle θ calculated in step S230 1e Substituting into the following formula, the hook traction force F can be calculated. DP , 2. A method for evaluating the traction of a wheel hook in soft terrain according to claim 1, characterized in that: In step S210, it specifically includes: Step S211, using a level to measure the proximity switch number corresponding to the X+ direction of the six-dimensional force sensor's own coordinate system, setting the horizontal direction of the vehicle body forward as the X axis, the forward direction as the positive direction, and when the X+ of the six-dimensional force sensor coincides with the X+ of the world coordinate system, it is set as the 0 angle position; Step S212, when the wheel rotates, the angle sensor integrated with the six-dimensional force sensor can output the absolute angle α in the X+ direction of the six-dimensional force sensor's own coordinate system, that is, one counterclockwise rotation increases from 0° to 360°, and the vertical downward angle is 270°. The proximity switch number corresponding to the vertical direction can be calculated based on the internal proximity switch number.
3. The method for evaluating the traction of a wheel hook in soft terrain according to claim 2, characterized in that: The actual output of the angle sensor is a voltage value. When it is actually used, the host computer program is required to convert the voltage value into a radian value. The real-time collection of the angle value and the numbering sequence of the internal proximity switch are used to determine the angle relationship between the sensor X+ and the corresponding proximity switch number.
4. The method for evaluating the traction of a wheel hook in soft terrain according to claim 3, characterized in that: The interpolation algorithm is used to optimize the error and reduce the contact angle detection error.
5. The method for evaluating the traction of a wheel hook in soft terrain according to claim 4, characterized in that: In step S240, the support force F N The driving torque T can be obtained by static analysis of the vehicle. D It can be obtained by detecting the motor current according to the relationship curve between the motor current and the motor torque.
6. A method for evaluating the traction of a wheel hook in soft terrain according to claim 5, characterized in that: In practical applications, it is only necessary to use a proximity switch to measure the entry angle θ1.
7. A method for evaluating the traction of a wheel hook in soft terrain according to claim 6, characterized in that: The number of the capacitive proximity switches may be 32, and the data of the capacitive proximity switches is represented by a string of 0s and 1s, where 1 indicates that the proximity switch is in contact with the terrain, and 0 indicates that the proximity switch is not in contact with the terrain.
8. A computer-readable storage medium, characterized in that: The computer-readable storage medium stores a computer program, and the computer program is configured to implement the steps of the method for evaluating the traction force of a wheel hook in soft terrain in any one of claims 1 to 7 when called by a processor.
