<?xml version="1.0" encoding="UTF-8"?>
<!DOCTYPE article PUBLIC "-//NLM//DTD JATS (Z39.96) Journal Publishing DTD v1.3 20210610//EN" "JATS-journalpublishing1-3-mathml3.dtd">
<article xmlns:mml="http://www.w3.org/1998/Math/MathML" xmlns:xlink="http://www.w3.org/1999/xlink" xmlns:ali="http://www.niso.org/schemas/ali/1.0/" xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance" article-type="research-article" dtd-version="1.3" xml:lang="EN">
<front>
<journal-meta>
<journal-id journal-id-type="publisher-id">Front. Plant Sci.</journal-id>
<journal-title-group>
<journal-title>Frontiers in Plant Science</journal-title>
<abbrev-journal-title abbrev-type="pubmed">Front. Plant Sci.</abbrev-journal-title>
</journal-title-group>
<issn pub-type="epub">1664-462X</issn>
<publisher>
<publisher-name>Frontiers Media S.A.</publisher-name>
</publisher>
</journal-meta>
<article-meta>
<article-id pub-id-type="doi">10.3389/fpls.2026.1754703</article-id>
<article-version article-version-type="Version of Record" vocab="NISO-RP-8-2008"/>
<article-categories>
<subj-group subj-group-type="heading">
<subject>Original Research</subject>
</subj-group>
</article-categories>
<title-group>
<article-title>Dynamics simulation and autonomous driving algorithm integration of unmanned harvester based on TruckSim/Simulink</article-title>
</title-group>
<contrib-group>
<contrib contrib-type="author">
<name><surname>Sun</surname><given-names>Liang</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="conceptualization" vocab-term-identifier="https://credit.niso.org/contributor-roles/conceptualization/">Conceptualization</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Funding acquisition" vocab-term-identifier="https://credit.niso.org/contributor-roles/funding-acquisition/">Funding acquisition</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="methodology" vocab-term-identifier="https://credit.niso.org/contributor-roles/methodology/">Methodology</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; review &amp; editing" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-review-editing/">Writing &#x2013; review &amp; editing</role>
</contrib>
<contrib contrib-type="author">
<name><surname>Wang</surname><given-names>Qiaolong</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="conceptualization" vocab-term-identifier="https://credit.niso.org/contributor-roles/conceptualization/">Conceptualization</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="software" vocab-term-identifier="https://credit.niso.org/contributor-roles/software/">Software</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; original draft" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-original-draft/">Writing &#x2013; original draft</role>
</contrib>
<contrib contrib-type="author">
<name><surname>Kong</surname><given-names>ZiYang</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="investigation" vocab-term-identifier="https://credit.niso.org/contributor-roles/investigation/">Investigation</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; review &amp; editing" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-review-editing/">Writing &#x2013; review &amp; editing</role>
</contrib>
<contrib contrib-type="author">
<name><surname>Feng</surname><given-names>Wenfei</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="supervision" vocab-term-identifier="https://credit.niso.org/contributor-roles/supervision/">Supervision</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; review &amp; editing" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-review-editing/">Writing &#x2013; review &amp; editing</role>
</contrib>
<contrib contrib-type="author" corresp="yes">
<name><surname>Xu</surname><given-names>Tao</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<xref ref-type="aff" rid="aff2"><sup>2</sup></xref>
<xref ref-type="aff" rid="aff3"><sup>3</sup></xref>
<xref ref-type="corresp" rid="c001"><sup>*</sup></xref>
<uri xlink:href="https://loop.frontiersin.org/people/3294768/overview"/>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="investigation" vocab-term-identifier="https://credit.niso.org/contributor-roles/investigation/">Investigation</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="methodology" vocab-term-identifier="https://credit.niso.org/contributor-roles/methodology/">Methodology</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; review &amp; editing" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-review-editing/">Writing &#x2013; review &amp; editing</role>
</contrib>
<contrib contrib-type="author">
<name><surname>Yu</surname><given-names>Gaohong</given-names></name>
<xref ref-type="aff" rid="aff1"><sup>1</sup></xref>
<xref ref-type="aff" rid="aff2"><sup>2</sup></xref>
<xref ref-type="aff" rid="aff3"><sup>3</sup></xref>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Funding acquisition" vocab-term-identifier="https://credit.niso.org/contributor-roles/funding-acquisition/">Funding acquisition</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="investigation" vocab-term-identifier="https://credit.niso.org/contributor-roles/investigation/">Investigation</role>
<role vocab="credit" vocab-identifier="https://credit.niso.org/" vocab-term="Writing &#x2013; review &amp; editing" vocab-term-identifier="https://credit.niso.org/contributor-roles/writing-review-editing/">Writing &#x2013; review &amp; editing</role>
</contrib>
</contrib-group>
<aff id="aff1"><label>1</label><institution>School of Mechanical Engineering, Zhejiang Sci-Tech University</institution>, <city>Hangzhou</city>,&#xa0;<country country="cn">China</country></aff>
<aff id="aff2"><label>2</label><institution>Key Laboratory of Agricultural Equipment for Hilly and Mountainous Areas in Southeastern China (Co-construction by Ministry and Province), Ministry of Agriculture and Rural Affairs</institution>, <city>Hangzhou</city>,&#xa0;<country country="cn">China</country></aff>
<aff id="aff3"><label>3</label><institution>Zhejiang Provincial Key Laboratory of Agricultural Intelligent Sensing and Robotics</institution>, <city>Hangzhou</city>,&#xa0;<country country="cn">China</country></aff>
<author-notes>
<corresp id="c001"><label>*</label>Correspondence: Tao Xu, <email xlink:href="mailto:xutao95@zstu.edu.cn">xutao95@zstu.edu.cn</email></corresp>
</author-notes>
<pub-date publication-format="electronic" date-type="pub" iso-8601-date="2026-03-03">
<day>03</day>
<month>03</month>
<year>2026</year>
</pub-date>
<pub-date publication-format="electronic" date-type="collection">
<year>2026</year>
</pub-date>
<volume>17</volume>
<elocation-id>1754703</elocation-id>
<history>
<date date-type="received">
<day>26</day>
<month>11</month>
<year>2025</year>
</date>
<date date-type="accepted">
<day>02</day>
<month>02</month>
<year>2026</year>
</date>
<date date-type="rev-recd">
<day>28</day>
<month>01</month>
<year>2026</year>
</date>
</history>
<permissions>
<copyright-statement>Copyright &#xa9; 2026 Sun, Wang, Kong, Feng, Xu and Yu.</copyright-statement>
<copyright-year>2026</copyright-year>
<copyright-holder>Sun, Wang, Kong, Feng, Xu and Yu</copyright-holder>
<license>
<ali:license_ref start_date="2026-03-03">https://creativecommons.org/licenses/by/4.0/</ali:license_ref>
<license-p>This is an open-access article distributed under the terms of the <ext-link ext-link-type="uri" xlink:href="https://creativecommons.org/licenses/by/4.0/">Creative Commons Attribution License (CC BY)</ext-link>. The use, distribution or reproduction in other forums is permitted, provided the original author(s) and the copyright owner(s) are credited and that the original publication in this journal is cited, in accordance with accepted academic practice. No use, distribution or reproduction is permitted which does not comply with these terms.</license-p>
</license>
</permissions>
<abstract>
<p>To enhance the path tracking accuracy and dynamic adaptability of small unmanned harvesters in complex farmland environments, this paper proposes a simulation and autonomous driving algorithm framework based on TruckSim and Simulink. By innovatively integrating TruckSim&#x2019;s high-precision dynamic simulation with Simulink&#x2019;s powerful algorithm development capabilities, we have constructed a comprehensive simulation platform that accurately models the harvester&#x2019;s behavior in agricultural settings. This platform not only accurately simulates dynamic responses under various operating conditions but also facilitates efficient testing and validation of autonomous driving algorithms, thereby significantly shortening development cycles and lowering field-testing costs. For path planning, we implement a hybrid A* algorithm with dual heuristic search strategy to generate optimal paths in typical static agricultural operations. At the control level, a PID controller is designed to optimize path tracking and speed control performance. Furthermore, an Extended Kalman Filter-based road adhesion coefficient identification method is introduced, which integrates multi-sensor data to dynamically estimate road conditions and adjust control strategies accordingly. To enhance system robustness, a PID-based lane-keeping algorithm with steering-speed coordination mechanism is incorporated, significantly improving operational stability in various farmland environments. Field validation results demonstrate that this research provides an innovative simulation tool and effective algorithm validation platform, advancing the development of intelligent agricultural equipment.</p>
</abstract>
<kwd-group>
<kwd>agricultural scenes</kwd>
<kwd>dual heuristic search</kwd>
<kwd>EKF</kwd>
<kwd>hybrid A*</kwd>
<kwd>intelligent agricultural equipment</kwd>
<kwd>lane keeping</kwd>
<kwd>PID control</kwd>
</kwd-group>
<funding-group>
<funding-statement>The author(s) declared that financial support was received for this work and/or its publication. The authors gratefully acknowledge the financial support provided in part by the National Key Research and Development Program of China (Grant No 2022YFD2001802), in part by the National Natural Science Foundation of China (Grant No 52375275).</funding-statement>
</funding-group>
<counts>
<fig-count count="25"/>
<table-count count="5"/>
<equation-count count="16"/>
<ref-count count="29"/>
<page-count count="22"/>
<word-count count="12327"/>
</counts>
<custom-meta-group>
<custom-meta>
<meta-name>section-at-acceptance</meta-name>
<meta-value>Sustainable and Intelligent Phytoprotection</meta-value>
</custom-meta>
</custom-meta-group>
</article-meta>
</front>
<body>
<sec id="s1" sec-type="intro">
<label>1</label>
<title>Introduction</title>
<p>Autonomous driving technology for unmanned harvesters has become a focal point in the field of agricultural automation (<xref ref-type="bibr" rid="B9">Fujinaga, 2025</xref>). Developing efficient and precise autonomous driving technology has become key to improving the work efficiency and stability of agricultural machinery (<xref ref-type="bibr" rid="B1">Bai et&#xa0;al., 2023</xref>). However, existing technologies still encounter bottlenecks in environmental perception, path planning, and control strategy optimization during operation, especially in complex farmland environments, posing severe challenges to the stability and robustness of autonomous driving systems.</p>
<p>In response to these challenges, extensive research both domestically and internationally has explored various issues related to agricultural autonomous driving technology, with most studies focusing on path planning and environmental perception. International research has utilized deep learning and computer vision technologies to achieve obstacle detection and recognition in farmland environments, performing instance segmentation of crops, obstacles, and field roads through visual sensors. For example, vision perception systems based on convolutional neural networks (CNN) and deep learning have been widely applied in agricultural robots to enable precise detection and identification of plants, weeds, and crops (<xref ref-type="bibr" rid="B11">Indolia et&#xa0;al., 2018</xref>). In terms of path planning, foreign researchers often employ traditional algorithms such as A* and Dijkstra to search for the optimal path from start to end points in complex farmland (<xref ref-type="bibr" rid="B24">Rachmawati and Gustin, 2020</xref>). At the same time, deep learning methods like CNNs and long short-term memory networks (LSTM) have also been introduced to enhance the intelligence and adaptability of path planning. Additionally, environmental perception technologies based on LiDAR and RGB cameras combined with machine learning methods have significantly improved the efficiency and accuracy of path planning, while also enhancing the stability and precision of autonomous navigation systems.</p>
<p>Currently, many agricultural autonomous driving systems can achieve efficient path planning in static environments, but their performance is suboptimal in dynamic and complex obstacle scenarios. In recent years, deep reinforcement learning (DRL) has emerged as a new direction for path planning. This approach enables agricultural robots to autonomously learn and optimize strategies, allowing them to self-adjust in dynamic environments and enhancing the intelligence and adaptability of path planning (<xref ref-type="bibr" rid="B16">Li et&#xa0;al., 2024</xref>). With advancements in deep learning and sensor technologies, multi-sensor fusion methods for environmental perception have made significant progress. For example, systems combining LiDAR and visual sensors can more accurately identify obstacles and crops in farmland, enabling real-time path planning and control decisions based on this information (<xref ref-type="bibr" rid="B19">Nehme et&#xa0;al., 2021</xref>; <xref ref-type="bibr" rid="B2">Ban et&#xa0;al., 2024</xref>) proposed a method (named CLI-Fusion) based on camera fusion, light detection and ranging (LiDAR), and an inertial measurement unit (IMU) to accurately extract real-time navigation lines between maize crop rows during the seedling stage (<xref ref-type="bibr" rid="B14">Kang et&#xa0;al., 2022</xref>) proposed a LiDAR-camera fusion visual system based on LiDAR and a fruit segmentation method utilizing deep learning to achieve accurate fruit localization within natural orchard environments.</p>
<p>In terms of control strategies, PID controllers have found extensive application in autonomous driving and agricultural machinery control due to their simplicity, ease of implementation, and robust performance (<xref ref-type="bibr" rid="B23">Peicheng et&#xa0;al., 2022</xref>). For instance, in vehicle path tracking control, PID controllers achieve precise guidance by adjusting lateral deviation and heading deviation; in speed control, they effectively suppress external disturbances to maintain stable vehicle velocity (<xref ref-type="bibr" rid="B15">Kebbati et&#xa0;al., 2021</xref>). Research both domestically and internationally indicates that PID controllers demonstrate excellent stability and responsiveness within agricultural machinery control systems, with their advantages particularly evident when handling the non-linear and dynamic variations inherent in field environments (<xref ref-type="bibr" rid="B12">Jin X. et&#xa0;al., 2024</xref>). For instance, certain studies integrate PID controllers with visual navigation systems to achieve autonomous navigation and stable control for tractors during field operations (<xref ref-type="bibr" rid="B1">Bai et&#xa0;al., 2023</xref>). Other research utilizes PID controllers to regulate the travel speed and header height of combine harvesters, thereby enhancing operational quality and efficiency (<xref ref-type="bibr" rid="B28">Zhang et&#xa0;al., 2025</xref>). These application cases validate the practicality and reliability of PID controllers within agricultural autonomous driving systems.</p>
<p>In practical applications, sensor noise and uncertainties affect system accuracy. Therefore, research has begun exploring filtering algorithms such as Kalman filtering and extended Kalman filtering to improve data quality and accuracy. By fusing multi-sensor data (such as wheel speed sensors, accelerometers, and gyroscopes) (<xref ref-type="bibr" rid="B5">Chua et&#xa0;al., 2011</xref>), the system can estimate the road adhesion coefficient in real time, dynamically adjust control strategies, and optimize path tracking and speed control. The road adhesion coefficient is crucial for the traction and stability of agricultural vehicles; its variations under different terrains and weather conditions significantly impact vehicle stability and safety. The PID controller adjusts vehicle path tracking and lateral stability in real time, ensuring automatic correction of deviations and maintaining stable driving across various farmland environments. By continuously optimizing the proportional, integral, and derivative parameters, the control strategy maintains high stability and accuracy under changing conditions. This innovative technology enables the simulation system to more realistically reflect actual control requirements and provides an effective means to test the robustness of autonomous driving algorithms in dynamic environments, further enhancing the adaptability and reliability of agricultural autonomous driving systems.</p>
<p>In order to achieve the vehicle&#x2019;s dynamic response under different operating conditions, conduct real-time testing and validation of autonomous driving algorithms, shorten the algorithm development cycle, reduce the cost of field testing, improve research and development efficiency, and lower development costs, this study provides practical solutions. The main work of this research is as follows:</p>
<list list-type="order">
<list-item>
<p>Develop a high-fidelity simulation platform by innovatively adopting a TruckSim-Simulink collaborative framework to establish a wheeled equivalent model of a tracked harvester, achieving high-precision simulation of key dynamic characteristics such as yaw response and lateral acceleration.</p></list-item>
<list-item>
<p>A multimodal environmental perception system is proposed, utilizing a classic PID controller to optimize path tracking and speed control, and introducing an Extended Kalman Filter (EKF) for rapid identification of road adhesion coefficients.</p></list-item>
<list-item>
<p>Proposed an adaptive decision-making and planning framework that uses a hybrid A* algorithm for path planning. By combining a dual heuristic search strategy, it can quickly find the optimal path and improve search efficiency.</p></list-item>
</list>
<p>In summary, this study proposes an integrated simulation and control framework based on TruckSim/Simulink to enhance the autonomous operation capabilities of small unmanned harvesters in complex agricultural environments. By constructing a high-fidelity collaborative simulation platform, the framework resolves the challenge of lacking dedicated models for target harvesters; innovatively integrates extended Kalman filtering for real-time identification of road adhesion coefficients, providing critical environmental perception data for control decisions; and employs a hybrid A* algorithm with PID control to achieve efficient path planning and precise tracking. The value of this research lies not only in algorithmic integration and methodological innovation, but also in its provision of practical technical support for smart agriculture development: the constructed simulation platform can significantly shorten the R&amp;D cycle of autonomous driving systems for agricultural equipment while reducing field testing costs and risks; The proposed perception and control strategies markedly enhance the harvester&#x2019;s operational adaptability and safety across complex terrains such as hilly regions and slippery, muddy fields; The entire system establishes a critical technological foundation for advancing from single-machine intelligent operations to future multi-machine collaborative operations in unmanned farms. It holds clear engineering application prospects for addressing agricultural labor shortages and driving the transformation of agricultural production methods towards precision and automation (<xref ref-type="bibr" rid="B18">Montemerlo et&#xa0;al., 2008</xref>).</p>
</sec>
<sec id="s2" sec-type="materials|methods">
<label>2</label>
<title>Materials and methods</title>
<sec id="s2_1">
<label>2.1</label>
<title>Establishment of the dynamic model</title>
<p>This study aims to develop an autonomous driving algorithm simulation framework for small unmanned harvesters. However, due to the lack of a high-fidelity specialized model precisely matching the target platform&#x2014;a small full-feed tracked combine harvester&#x2014;in the standard model library of the selected simulation software (TruckSim), this study strategically selected the built-in TruckSim model (used for theoretical model derivation in Section 1 of this chapter) and the Suzhou King Long KLQ6125D bus model (used for vehicle dynamics simulation and control system validation in Section 4 of this chapter) as alternative simulation platforms (<xref ref-type="bibr" rid="B17">Mechanical Simulation Corporation, 2021</xref>). This choice is based on the following considerations:</p>
<sec id="s2_1_1">
<label>2.1.1</label>
<title>Universality of dynamic principles</title>
<p>The fundamental physical principles involved in core research topics such as vehicle yaw stability, lateral dynamics, tire-road interaction (adhesion coefficient identification), and path tracking control (PID)&#x2014;including Newtonian mechanics, kinematics, and control theory&#x2014;are universally applicable to wheeled vehicles. Both the tractor-trailer model, with its structural complexity (multi-body connections), and the bus model, in terms of maneuvering stability analysis, can effectively support this study&#x2019;s validation requirements for core algorithms (A*/hybrid A*, EKF, PID).</p>
</sec>
<sec id="s2_1_2">
<label>2.1.2</label>
<title>Parameter adjustability</title>
<p>TruckSim allows for extensive adjustments to key parameters of the selected model (such as mass, wheelbase, track width, moment of inertia, tire characteristics, etc.). In this study, the simulation model was specifically parameterized based on publicly available data and the key characteristic parameters of small harvesters (such as curb weight range, typical dimensions, and converting tracked ground contact characteristics into equivalent wheeled parameters), aiming to accurately replicate the typical features of the target harvester at the core dynamic behavior level (including yaw response, lateral acceleration, and path-following capability).</p>
</sec>
<sec id="s2_1_3">
<label>2.1.3</label>
<title>Consideration of track characteristics</title>
<p>The target harvester is a tracked vehicle, which inherently differs from the selected wheeled model (e.g., steering mechanism, ground pressure distribution, slip characteristics). In this study, tire model parameters (such as longitudinal slip stiffness and cornering stiffness) are adjusted to approximate the equivalent behavior of the tracked vehicle in path tracking and stability control. This simplification is reasonable and effective for validating the core control algorithms under low-speed, small-to-medium steering angle conditions (typical speeds for field operations:&lt;2.0 m/s). Track-specific dynamic effects (such as steering resistance torque and ground deformation) will be the focus of investigation in real vehicle testing.</p>
<p>To ensure the selected wheeled model is dynamically equivalent to the target tracked harvester, this study conducted systematic parameter mapping and response comparison analysis, with the following specific quantitative metrics:</p>
<sec id="s2_1_3_1">
<label>2.1.3.1</label>
<title>Equivalent adjustment of mass-inertia parameters</title>
<p>The target harvester&#x2019;s total mass is m<sub>h</sub>=1200kg. The moment of inertia about the Z-axis, <italic>I<sub>z,h</sub></italic>, is estimated at approximately 1800 kg&#xb7;m&#xb2; (based on empirical formulas for external dimensions and mass distribution). The selected bus model (KLQ6125D) has an original kerb weight of 5025 kg, with <italic>Iz</italic> approximately 12000 kg&#xb7;m&#xb2;. Using Trucksim&#x2019;s parameter adjustment function, the simulation model&#x2019;s mass was proportionally scaled to 1250 kg (error +4.2%) and Iz adjusted to 1950 kg&#xb7;m&#xb2;(error +8.3%) to ensure the lateral moment of inertia remained within a reasonable range equivalent to the target harvester.</p>
</sec>
<sec id="s2_1_3_2">
<label>2.1.3.2</label>
<title>Geometric dimensions and kinematic parameters mapping</title>
<p>The track gauge of the harvester is 710 mm, with both front and rear wheelbases of the wheeled model set to 700 mm (error -1.4%). By adjusting the wheelbase to 2200 mm and positioning the center of gravity at the wheelbase midpoint, steady-state yaw rate response during low-speed steering aligns with that of tracked vehicles. Verification through step-turn simulations at <italic>v<sub>x</sub></italic> = 1.0 m/s and front wheel angle <inline-formula>
<mml:math display="inline" id="im1"><mml:mi>&#x3b4;</mml:mi></mml:math></inline-formula>=10&#xb0; demonstrated steady-state yaw rates of 0.152 rad/s for the selected model and 0.165 rad/s for the target harvester&#x2019;s simplified model, yielding a relative error of 7.9%.</p>
</sec>
<sec id="s2_1_3_3">
<label>2.1.3.3</label>
<title>Equivalent validation of tyre/track force characteristics</title>
<p>To simulate the ground pressure distribution and force transmission characteristics of the track, adjustments were made to the longitudinal stiffness <italic>C<sub>x</sub></italic> and lateral stiffness <italic>C<sub>&#x3b1;</sub></italic> based on the Magic Formula tyre model: <italic>C<sub>x</sub></italic>, <italic>C<sub>&#x3b1;</sub></italic> were set to <italic>C<sub>x</sub></italic> = 1.2&#xd7;10<sup>5</sup>N, <italic>C<sub>&#x3b1;</sub></italic> = 8&#xd7;10<sup>4</sup>N/rad. This ensures consistency with the track traction-slip rate curve trend within the low-speed slip range (&lt;0.1). In simulations at <italic>v<sub>x</sub></italic> = 1.5 m/s with sinusoidal steering input (amplitude 8&#xb0;, frequency 0.2 Hz), the normalized root mean square error (NRMSE) between the simulated lateral acceleration response amplitude and the expected value for the tracked vehicle was 13.2%.</p>
</sec>
<sec id="s2_1_3_4">
<label>2.1.3.4</label>
<title>Path tracing performance consistency verification</title>
<p>Under identical PID control parameters (Kp=1.2, Ki=0.05, Kd=0.12), linear tracking and S-curve tracking simulations were conducted to compare the selected model with the simplified target harvester model. Results indicate: During straight-line tracking (speed 1.0 m/s), the mean lateral errors were 0.041 m (wheeled) and 0.038 m (tracked), representing a 7.9% difference. During S-curve tracking, the maximum lateral errors were 0.118 m and 0.125 m respectively, differing by 5.6%.</p>
</sec>
<sec id="s2_1_3_5">
<label>2.1.3.5</label>
<title>Equivalence comprehensive evaluation indicators</title>
<p>Define the equivalence evaluation function, whose expression is shown in <xref ref-type="disp-formula" rid="eq1">Equation 1</xref>:</p>
<disp-formula id="eq1"><label>(1)</label>
<mml:math display="block" id="M1"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>E</mml:mi><mml:mrow><mml:mi>e</mml:mi><mml:mi>q</mml:mi></mml:mrow></mml:msub><mml:mo>=</mml:mo><mml:mfrac><mml:mn>1</mml:mn><mml:mi>n</mml:mi></mml:mfrac><mml:munderover><mml:mo>&#x2211;</mml:mo><mml:mrow><mml:mi>i</mml:mi><mml:mo>=</mml:mo><mml:mn>1</mml:mn></mml:mrow><mml:mi>n</mml:mi></mml:munderover><mml:mrow><mml:mo>|</mml:mo><mml:mrow><mml:mfrac><mml:mrow><mml:msub><mml:mi>y</mml:mi><mml:mrow><mml:mi>w</mml:mi><mml:mi>h</mml:mi><mml:mi>e</mml:mi><mml:mi>e</mml:mi><mml:mi>l</mml:mi><mml:mo>,</mml:mo><mml:mi>i</mml:mi></mml:mrow></mml:msub><mml:mo>&#x2212;</mml:mo><mml:msub><mml:mi>y</mml:mi><mml:mrow><mml:mi>t</mml:mi><mml:mi>r</mml:mi><mml:mi>a</mml:mi><mml:mi>c</mml:mi><mml:mi>k</mml:mi><mml:mo>,</mml:mo><mml:mi>i</mml:mi></mml:mrow></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>y</mml:mi><mml:mrow><mml:mi>t</mml:mi><mml:mi>r</mml:mi><mml:mi>a</mml:mi><mml:mi>c</mml:mi><mml:mi>k</mml:mi><mml:mo>,</mml:mo><mml:mi>i</mml:mi></mml:mrow></mml:msub></mml:mrow></mml:mfrac></mml:mrow><mml:mo>|</mml:mo></mml:mrow><mml:mo>&#xd7;</mml:mo><mml:mn>100</mml:mn><mml:mo>%</mml:mo></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Among these, y encompasses key response variables such as the peak yaw rate, lateral acceleration amplitude, and path tracking error. Based on simulations of six typical operating conditions, the average equivalent error <italic>E<sub>eq</sub></italic> was calculated to be 11.7%, indicating that the selected wheeled model exhibits acceptable dynamic equivalence with the target tracked harvester under low-speed conditions and small-to-medium steering angles.</p>
<p>In summary, through the aforementioned parameter adjustments and response comparisons, the selected tractor-trailer and bus models demonstrate excellent consistency with the target harvester in terms of mass inertia, kinematic response, force characteristics, and path-following performance. This provides a reasonable and reliable simulation platform for subsequent control algorithm validation.</p>
<p>The following is the specific parameter adjustment table for model equivalent amplification.</p>
<p>The reference model established in this section primarily focuses on the vehicle&#x2019;s yaw stability and lateral dynamic response, both of which form the foundation of the dynamics of wheeled and tracked ground vehicles. Concepts involved in the model, such as forces (tire lateral forces), moments, and geometric relationships (wheelbase, articulation point locations), are fundamentally applicable to analyzing the overall motion of tracked vehicles as well. Neglecting the effects of suspension as well as pitch and roll motions is reasonable for concentrating on the core objective of studying lateral path tracking and yaw stability, and this simplification is widely adopted in vehicle control research. The selected TruckSim model is the 3A Tractor with 3A Flatbed Trailer. The actual vehicle is the Nongjiapan 4LZ-1.5A full-feed tracked combine harvester produced by Xiangyuan Jinsui Harvester Manufacturing Co., Ltd. in Shuangfeng County, Hunan Province. The technical specifications of this combine harvester are detailed in <xref ref-type="table" rid="T1"><bold>Table&#xa0;1</bold></xref>.</p>
<table-wrap id="T1" position="float">
<label>Table&#xa0;1</label>
<caption>
<p>Technical parameters of harvester.</p>
</caption>
<table frame="hsides">
<thead>
<tr>
<th valign="middle" align="center">Item</th>
<th valign="middle" align="center">Data</th>
<th valign="middle" align="center">Unit</th>
</tr>
</thead>
<tbody>
<tr>
<td valign="middle" align="center">Overall Dimensions</td>
<td valign="middle" align="center">3800&#xd7;1660&#xd7;2480</td>
<td valign="middle" align="center">mm</td>
</tr>
<tr>
<td valign="middle" align="center">Machine Weight</td>
<td valign="middle" align="center">1200</td>
<td valign="middle" align="center">kg</td>
</tr>
<tr>
<td valign="middle" align="center">Header Working Width</td>
<td valign="middle" align="center">1350</td>
<td valign="middle" align="center">mm</td>
</tr>
<tr>
<td valign="middle" align="center">Rated Feed Rate</td>
<td valign="middle" align="center">1.5</td>
<td valign="middle" align="center">kg/s</td>
</tr>
<tr>
<td valign="middle" align="center">Operating Speed</td>
<td valign="middle" align="center">0.6-2.0</td>
<td valign="middle" align="center">m/s</td>
</tr>
<tr>
<td valign="middle" align="center">Track Gauge</td>
<td valign="middle" align="center">710</td>
<td valign="middle" align="center">mm</td>
</tr>
</tbody>
</table>
</table-wrap>
<p>To simplify the modeling, this paper simplifies the two drive axles of the tractor into a single axle, and the three axles of the semi-trailer into a single axle, as shown in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref>. The simplified dynamic model of the tractor-semitrailer shown in this figure is an equivalent wheeled abstraction of the actual tracked harvester in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2</bold></xref>, used to simulate its core yaw and lateral dynamic behavior. This four-degree-of-freedom reference model can describe the yaw motion, lateral motion, and dynamic characteristics of the tractor and semi-trailer (<xref ref-type="bibr" rid="B25">Rajamani, 2012</xref>). Based on this, the following assumptions are made: the front wheel steering angle is taken as the input, and the influence of the steering system is neglected.</p>
<fig id="f1" position="float">
<label>Figure&#xa0;1</label>
<caption>
<p>Model simplification diagram.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g001.tif">
<alt-text content-type="machine-generated">Mechanical diagram illustrating a vehicle with three distinct wheel placements labeled with forces, mass points, and dimensions such as a, b, c, l1, l2. Angles, force vectors, and local coordinate axes are depicted, along with global XY axes showing rotation angles &#x3c6; and &#x3b8;.</alt-text>
</graphic></fig>
<fig id="f2" position="float">
<label>Figure&#xa0;2</label>
<caption>
<p>3D model of a combine harvester: <bold>(a)</bold> Harvesting system <bold>(b)</bold> Harvester body <bold>(c)</bold> Steering mechanism <bold>(d)</bold> Whole machine center of mass <bold>(e)</bold> Track system.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g002.tif">
<alt-text content-type="machine-generated">Labeled diagram shows a colored 3D model of a combine harvester with five main components identified: (a) harvesting system at the front, (b) harvester body, (c) steering mechanism, (d) whole machine center of mass, and (e) track system at the base.</alt-text>
</graphic></fig>
<list list-type="order">
<list-item>
<p>Assuming the vehicle&#x2019;s longitudinal speed remains constant;</p></list-item>
<list-item>
<p>Assuming the vehicle is traveling on a flat road surface, the vertical motion of the vehicle can be neglected.</p></list-item>
<list-item>
<p>Ignoring pitch and roll movements;</p></list-item>
<list-item>
<p>Ignoring the effects of aerodynamics and road gradient;</p></list-item>
</list>
<p>The above assumptions are based on the actual operational characteristics of agricultural harvesters: &#x2460; The tracked harvester operates at a low speed (0.6-2.0 m/s), and longitudinal acceleration changes can be neglected; &#x2461; The slope of farmland roads is usually less than 5&#xb0;, making the assumption of a level road surface reasonable (<xref ref-type="bibr" rid="B4">Chen et&#xa0;al., 2022</xref>); &#x2462; The suspension system has a minimal effect on low-speed lateral dynamics, so pitch and roll are neglected (<xref ref-type="bibr" rid="B26">Sert and Boyraz, 2017</xref>); &#x2463; Air resistance at low speeds is less than 3% of the rated tractive force (calculated using parameters in <xref ref-type="table" rid="T1"><bold>Table&#xa0;1</bold></xref>) and is therefore ignored. To construct the dynamic model of the tractor-trailer system, we conducted separate mechanical analyses of the tractor and semi-trailer, as shown in <xref ref-type="disp-formula" rid="eq2">Equations 2</xref>&#x2013;<xref ref-type="disp-formula" rid="eq6">6</xref>.</p>
<p>For the lateral force equilibrium equation of the tractor&#x2019;s center of gravity, the following <xref ref-type="disp-formula" rid="eq2">Equation 2</xref> is derived:</p>
<disp-formula id="eq2"><label>(2)</label>
<mml:math display="block" id="M2"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mtext>m</mml:mtext><mml:mn>1</mml:mn></mml:msub><mml:msub><mml:mi>a</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub><mml:mo>=</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub><mml:mo>+</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>2</mml:mn></mml:mrow></mml:msub><mml:mo>&#x2212;</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mi>y</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Moment equation of the resultant forces about the center of gravity of the tractor, the following <xref ref-type="disp-formula" rid="eq3">Equation 3</xref> is derived:</p>
<disp-formula id="eq3"><label>(3)</label>
<mml:math display="block" id="M3"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mrow><mml:mi>z</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub><mml:msub><mml:mover accent="true"><mml:mi>&#x3b3;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mn>1</mml:mn></mml:msub><mml:mo>=</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub><mml:msub><mml:mi>a</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>2</mml:mn></mml:mrow></mml:msub><mml:msub><mml:mi>b</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub><mml:msub><mml:mi>l</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Lateral force equation of the center of gravity for a semi-trailer, the following <xref ref-type="disp-formula" rid="eq4">Equation 4</xref> is derived:</p>
<disp-formula id="eq4"><label>(4)</label>
<mml:math display="block" id="M4"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>m</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:msub><mml:mi>a</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>2</mml:mn></mml:mrow></mml:msub><mml:mo>=</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>3</mml:mn></mml:mrow></mml:msub><mml:mo>+</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Moment equation of the resultant force at the center of gravity of the semi-trailer, the following <xref ref-type="disp-formula" rid="eq5">Equation 5</xref> is derived:</p>
<disp-formula id="eq5"><label>(5)</label>
<mml:math display="block" id="M5"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mrow><mml:mi>z</mml:mi><mml:mn>2</mml:mn></mml:mrow></mml:msub><mml:msub><mml:mover accent="true"><mml:mi>&#x3b3;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mn>2</mml:mn></mml:msub><mml:mo>=</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mi>y</mml:mi></mml:msub><mml:msub><mml:mi>l</mml:mi><mml:mn>2</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>3</mml:mn></mml:mrow></mml:msub><mml:mi>c</mml:mi></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>In the formula: <inline-formula>
<mml:math display="inline" id="im2"><mml:mrow><mml:msub><mml:mtext>m</mml:mtext><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im3"><mml:mrow><mml:msub><mml:mtext>m</mml:mtext><mml:mn>2</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>: mass of the tractor/semi-trailer; <inline-formula>
<mml:math display="inline" id="im4"><mml:mrow><mml:msub><mml:mi>a</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im5"><mml:mrow><mml:msub><mml:mi>b</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im6"><mml:mrow><mml:msub><mml:mi>l</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>: distances from the tractor&#x2019;s center of gravity to the front axle, rear axle, and articulation point, respectively; <inline-formula>
<mml:math display="inline" id="im7"><mml:mi>c</mml:mi></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im8"><mml:mrow><mml:msub><mml:mi>l</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula>: distances from the semi-trailer&#x2019;s center of gravity to the rear axle and articulation point, respectively; <inline-formula>
<mml:math display="inline" id="im9"><mml:mrow><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>1</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im10"><mml:mrow><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>2</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im11"><mml:mrow><mml:msub><mml:mi>F</mml:mi><mml:mrow><mml:mi>y</mml:mi><mml:mn>3</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>: lateral forces on the front wheels, rear wheels, and semi-trailer wheels, respectively (<xref ref-type="bibr" rid="B13">Jin Y. et&#xa0;al., 2024</xref>). To accurately describe the complex kinematic coupling relationship between thetractor unit and semi-trailer in articulated vehicle systems, a decompositionexpression for the yaw angular velocity is introduced, as shown in <xref ref-type="disp-formula" rid="eq6">Equation 6</xref>.</p>
<disp-formula id="eq6"><label>(6)</label>
<mml:math display="block" id="M6"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mrow><mml:mo>{</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>&#x3b3;</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>=</mml:mo><mml:mover accent="true"><mml:mi>&#x3c6;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mo>+</mml:mo><mml:mover accent="true"><mml:mi>&#x3c8;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>&#x3b3;</mml:mi><mml:mn>2</mml:mn></mml:msub><mml:mo>=</mml:mo><mml:mover accent="true"><mml:mi>&#x3c6;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mo>+</mml:mo><mml:mover accent="true"><mml:mi>&#x3c8;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mo>+</mml:mo><mml:mover accent="true"><mml:mi>&#x3b8;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Among them, <inline-formula>
<mml:math display="inline" id="im12"><mml:mrow><mml:msub><mml:mi>&#x3b3;</mml:mi><mml:mrow><mml:mn>1</mml:mn><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im13"><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:msub><mml:mi>&#x3b3;</mml:mi><mml:mrow><mml:mn>2</mml:mn><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>: the yaw angular velocity (&#xb0;)/s of the tractor and semi-trailer; <inline-formula>
<mml:math display="inline" id="im14"><mml:mrow><mml:mover><mml:mrow><mml:mi>&#x3c6;</mml:mi><mml:mo>&#xa0;</mml:mo></mml:mrow><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mrow></mml:math></inline-formula>: the rotational angular velocity of the tractor around its own center of mass; <inline-formula>
<mml:math display="inline" id="im15"><mml:mrow><mml:mover><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:mi>&#x3c8;</mml:mi></mml:mrow><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mrow></mml:math></inline-formula>: the coupled angular velocity caused by the articulation point; <inline-formula>
<mml:math display="inline" id="im16"><mml:mover accent="true"><mml:mi>&#x3b8;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:math></inline-formula>: he relative angular velocity of the semi-trailer relative to the tractor. This system of equations forms the basis for deriving the moment equilibrium <xref ref-type="disp-formula" rid="eq2">Equations 2</xref>&#x2013;<xref ref-type="disp-formula" rid="eq5">5</xref>.</p>
<p><xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2</bold></xref> is a 3D model of the small harvester. The simplified model in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> is related to the actual harvester in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2</bold></xref> as follows: the tractor section corresponds to the main body of the harvester (including the power system and the cab); the semi-trailer section corresponds to the cutter bar and the collection system; the articulation point simulates the dynamic effects of the harvester&#x2019;s steering mechanism. The core purpose of this equivalent model is to accurately replicate the typical dynamic characteristics of the target harvester in path tracking and yaw stability analysis.</p>
<p>The harvesting system is divided into five parts: the harvesting system, the harvester body, the steering mechanism, the track system, and the whole machine center of mass. The &#x2018;semi-trailer&#x2019; part in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> corresponds to the &#x2018;cutting platform system&#x2019; in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2a</bold></xref>, and the &#x201c;tractor&#x201d; part in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> corresponds to the &#x2018;harvester body&#x2019; in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2b</bold></xref>. the &#x2018;articulation point&#x2019; in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> corresponds to the &#x2018;steering mechanism&#x2019; in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2c</bold></xref>, the &#x2018;center of gravity position&#x2019; in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> corresponds to the &#x2018;center of gravity position of the entire machine&#x2019; in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2d</bold></xref>, and the &#x2018;front wheels/rear wheels&#x2019; in <xref ref-type="fig" rid="f1"><bold>Figure&#xa0;1</bold></xref> correspond to the &#x2018;track system&#x2019; in <xref ref-type="fig" rid="f2"><bold>Figure&#xa0;2e</bold></xref>.</p>
</sec>
</sec>
</sec>
<sec id="s2_2">
<label>2.2</label>
<title>Road adhesion coefficient identification based on EKF</title>
<p>In the established dynamic model, the dynamic behavior of the tractor and semi-trailer is significantly influenced by the road adhesion coefficient &#x3bc;. &#x3bc; not only determines the vehicle&#x2019;s traction force and stability limits but also directly affects path planning and control system performance. Therefore, to achieve high-performance autonomous driving, this paper employs the Extended Kalman Filter (EKF) method to identify the road adhesion coefficient in real time (<xref ref-type="bibr" rid="B6">Ding et&#xa0;al., 2022</xref>). EKF utilizes the system state equations, observation equations, and the statistical characteristics of process noise and measurement noise to perform optimal estimation, enabling accurate estimation of &#x3bc; and providing critical road condition information to the control system (<xref ref-type="bibr" rid="B3">Bavdekar et&#xa0;al., 2011</xref>).</p>
<p>Real-time identification of &#x3bc; is crucial for dynamically adjusting vehicle control strategies, especially in complex and variable farmland road conditions. For example, under low &#x3bc; conditions, vehicle handling stability decreases, and the system must incorporate the real-time identified &#x3bc; results to ensure driving safety through path planning (such as the hybrid A* algorithm) and control decisions (such as PID parameter tuning or speed limiting).</p>
<p>To balance computational complexity and algorithm feasibility verification, a nonlinear three-degree-of-freedom vehicle model is used as the basis for the EKF. The core design of the EKF relies on four types of information: state equations, observation equations, process noise statistical characteristics, and measurement noise statistical characteristics. EKF achieves local linearization of the nonlinear model by performing a first-order Taylor expansion of the nonlinear functions at the current state estimate point (neglecting higher-order terms), making it widely applicable to various nonlinear system estimation problems. The EKF-based road adhesion coefficient identification process includes the following steps:</p>
<sec id="s2_2_1">
<label>2.2.1</label>
<title>Establishment of the system state equation and measurement equation</title>
<p>The state equation and measurement equation reflect the dynamic characteristics of the system and the feedback information from the sensors, respectively. The specific expressions are as follows:</p>
<p>General form of the state equation for a nonlinear system (<xref ref-type="disp-formula" rid="eq7">Equation 7</xref>):</p>
<disp-formula id="eq7"><label>(7)</label>
<mml:math display="block" id="M7"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mover accent="true"><mml:mi>x</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mi>f</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>x</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>u</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>w</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>General form of the system observation equations (<xref ref-type="disp-formula" rid="eq8">Equation 8</xref>):</p>
<disp-formula id="eq8"><label>(8)</label>
<mml:math display="block" id="M8"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi>y</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>x</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>v</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>In the equation: <inline-formula>
<mml:math display="inline" id="im17"><mml:mrow><mml:mover accent="true"><mml:mi>x</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:math></inline-formula> represents the state variable; <inline-formula>
<mml:math display="inline" id="im18"><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:mi>u</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> represents the control variable; <inline-formula>
<mml:math display="inline" id="im19"><mml:mrow><mml:mi>y</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:math></inline-formula> represents the measurement output; <inline-formula>
<mml:math display="inline" id="im20"><mml:mrow><mml:mi>w</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:math></inline-formula> represents the system excitation noise; <inline-formula>
<mml:math display="inline" id="im21"><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:mi>v</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> represents the measurement noise; <inline-formula>
<mml:math display="inline" id="im22"><mml:mrow><mml:mi>w</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>v</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> are independent white noises. <inline-formula>
<mml:math display="inline" id="im23"><mml:mi>Q</mml:mi></mml:math></inline-formula> is the covariance matrix of the system <inline-formula>
<mml:math display="inline" id="im24"><mml:mrow><mml:mi>w</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> &#x2018;s excitation noise, and <inline-formula>
<mml:math display="inline" id="im25"><mml:mi>R</mml:mi></mml:math></inline-formula> is the covariance matrix of the measurement noise <inline-formula>
<mml:math display="inline" id="im26"><mml:mrow><mml:mi>v</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>.</p>
<p>State equation based on the three-degree-of-freedom vehicle model (<xref ref-type="disp-formula" rid="eq9">Equation 9</xref>):</p>
<disp-formula id="eq9"><label>(9)</label>
<mml:math display="block" id="M9"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mtable columnalign="left"><mml:mtr columnalign="left"><mml:mtd columnalign="left"><mml:mrow><mml:mrow><mml:mo>{</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mover accent="true"><mml:mi>&#x3b3;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:msup><mml:mi>a</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msup><mml:mi>b</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>r</mml:mi><mml:mo>+</mml:mo><mml:mfrac><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>&#x3b2;</mml:mi><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>&#x3b4;</mml:mi></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mover accent="true"><mml:mi>&#x3b2;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mo>=</mml:mo><mml:mrow><mml:mo>(</mml:mo><mml:mrow><mml:mfrac><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac><mml:mo>&#x2212;</mml:mo><mml:mn>1</mml:mn></mml:mrow><mml:mo>)</mml:mo></mml:mrow><mml:mi>r</mml:mi><mml:mo>+</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>&#x3b2;</mml:mi><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>&#x3b4;</mml:mi></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mover accent="true"><mml:mi>v</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mi>x</mml:mi></mml:msub><mml:mo>=</mml:mo><mml:mi>r</mml:mi><mml:mi>&#x3b2;</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub><mml:mo>+</mml:mo><mml:msub><mml:mi>a</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable><mml:mo>&#xa0;</mml:mo></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Among them, <inline-formula>
<mml:math display="inline" id="im27"><mml:mi>a</mml:mi></mml:math></inline-formula> is the distance from the front axle to the center of mass, <inline-formula>
<mml:math display="inline" id="im28"><mml:mi>b</mml:mi></mml:math></inline-formula> is the distance from the rear axle to the center of mass, <inline-formula>
<mml:math display="inline" id="im29"><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula> is the lateral stiffness of the front wheel, <inline-formula>
<mml:math display="inline" id="im30"><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow></mml:math></inline-formula> is the lateral stiffness of the rear wheel, <inline-formula>
<mml:math display="inline" id="im31"><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub></mml:mrow></mml:math></inline-formula> is the moment of inertia around the z-axis of the vehicle, and <inline-formula>
<mml:math display="inline" id="im32"><mml:mi>m</mml:mi></mml:math></inline-formula> is the mass of the vehicle.</p>
<p>Measurement equation (lateral acceleration) (<xref ref-type="disp-formula" rid="eq10">Equation 10</xref>):</p>
<disp-formula id="eq10"><label>(10)</label>
<mml:math display="block" id="M10"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>a</mml:mi><mml:mi>y</mml:mi></mml:msub><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>&#x3c7;</mml:mi></mml:msub></mml:mrow></mml:mfrac><mml:mi>r</mml:mi><mml:mo>+</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mi>m</mml:mi></mml:mfrac><mml:mi>&#x3b2;</mml:mi><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mi>m</mml:mi></mml:mfrac><mml:mi>&#x3b4;</mml:mi></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Among them: <inline-formula>
<mml:math display="inline" id="im33"><mml:mrow><mml:mover accent="true"><mml:mi>x</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo stretchy="true">[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mover accent="true"><mml:mi>r</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mover accent="true"><mml:mi>&#x3b2;</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mover accent="true"><mml:mi>v</mml:mi><mml:mo>&#x2d9;</mml:mo></mml:mover><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo stretchy="true">]</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im34"><mml:mrow><mml:mi>y</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:msub><mml:mi>a</mml:mi><mml:mi>y</mml:mi></mml:msub></mml:mrow></mml:math></inline-formula></p>
<p>(2) Model Linearization</p>
<p><inline-formula>
<mml:math display="inline" id="im35"><mml:mrow><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo><mml:mo>,</mml:mo></mml:mrow><mml:mi>H</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> is the Jacobian matrix, which is the partial derivatives with respect to the state <inline-formula>
<mml:math display="inline" id="im36"><mml:mrow><mml:mi>x</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mtext>&#xa0;of&#xa0;nonlinearn&#xa0;function&#xa0;f</mml:mtext><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>x</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo><mml:mi>,</mml:mi></mml:mrow><mml:mi>u</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo><mml:mo>,</mml:mo></mml:mrow><mml:mi>w</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>&#x3001; <inline-formula>
<mml:math display="inline" id="im37"><mml:mrow><mml:mtext>h</mml:mtext><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>x</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>v</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>, <inline-formula>
<mml:math display="inline" id="im38"><mml:mrow><mml:mtext>&#x394;</mml:mtext><mml:mi>t</mml:mi></mml:mrow></mml:math></inline-formula> is the sampling time.</p>
<p>Define the system Jacobian matrix for the purpose of performing local linearisation of the nonlinear system. Define the system Jacobian matrix for the local linearisation of nonlinear systems, as shown in <xref ref-type="disp-formula" rid="eq1">Equation (11)</xref>.</p>
<disp-formula id="eq11"><label>(11)</label>
<mml:math display="block" id="M11"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo>[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>f</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>f</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>f</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>f</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo>]</mml:mo></mml:mrow><mml:mo>,</mml:mo><mml:mi>H</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo>[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>h</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>h</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd><mml:mtd><mml:mo>&#x22ee;</mml:mo></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>h</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mn>1</mml:mn></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>h</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow><mml:mrow><mml:mo>&#x2202;</mml:mo><mml:msub><mml:mi>x</mml:mi><mml:mi>m</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo>]</mml:mo></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Compute the discrete-time state transition matrix to discretise the continuous-time system for digital implementation, as shown in <xref ref-type="disp-formula" rid="eq12">Equation 12</xref>.</p>
<disp-formula id="eq12"><label>(12)</label>
<mml:math display="block" id="M12"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi>&#x3d5;</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:msup><mml:mi>e</mml:mi><mml:mrow><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>&#x2217;</mml:mo><mml:mi>&#x394;</mml:mi><mml:mi>t</mml:mi></mml:mrow></mml:msup><mml:mo>&#x2248;</mml:mo><mml:mi>I</mml:mi><mml:mo>+</mml:mo><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>&#x2217;</mml:mo><mml:mi>&#x394;</mml:mi><mml:mi>t</mml:mi></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Combining the above vehicle state-space equations and performing linearization, the matrix <inline-formula>
<mml:math display="inline" id="im39"><mml:mrow><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> and <inline-formula>
<mml:math display="inline" id="im40"><mml:mrow><mml:mi>H</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula> can be obtained.</p>
<p>Derive the specific expression for the system matrix F(t), revealing the dynamic coupling relationships between the state variables. The specific formula is shown in <xref ref-type="disp-formula" rid="eq13">Equation 13</xref>.</p>
<disp-formula id="eq13"><label>(13)</label>
<mml:math display="block" id="M13"><mml:mrow><mml:mi>F</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo>[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:msup><mml:mi>a</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:mi>r</mml:mi><mml:mtext>&#xa0;</mml:mtext><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msup><mml:mi>b</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:mi>&#x3b2;</mml:mi></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mi>&#x3b2;</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mi>r</mml:mi><mml:msub><mml:mi>v</mml:mi><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:mi>r</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msup><mml:mi>a</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msup><mml:mi>b</mml:mi><mml:mn>2</mml:mn></mml:msup><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:msub><mml:mi>I</mml:mi><mml:mi>z</mml:mi></mml:msub><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:mn>2</mml:mn><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mi>r</mml:mi></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:mi>&#x3b2;</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>k</mml:mi><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac><mml:mo>+</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>k</mml:mi><mml:mn>1</mml:mn></mml:msub><mml:mi>&#x3b4;</mml:mi></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mi>v</mml:mi><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mi>r</mml:mi><mml:mi>&#x3b2;</mml:mi></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo>]</mml:mo></mml:mrow></mml:mrow></mml:math>
</disp-formula>
<p>Derive the specific expression for the observation matrix H(t), determining the contribution of each state variable to the observed values. The specific formula is shown in <xref ref-type="disp-formula" rid="eq14">Equation 14</xref>.</p>
<disp-formula id="eq14"><label>(14)</label>
<mml:math display="block" id="M14"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi>H</mml:mi><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mi>t</mml:mi><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:mrow><mml:mo>[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mtext>k</mml:mtext><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mtext>k</mml:mtext><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msub><mml:mtext>v</mml:mtext><mml:mi>x</mml:mi></mml:msub></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msub><mml:mtext>k</mml:mtext><mml:mn>1</mml:mn></mml:msub><mml:mo>+</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mtext>k</mml:mtext><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mi>m</mml:mi></mml:mfrac></mml:mrow></mml:mtd></mml:mtr><mml:mtr><mml:mtd><mml:mrow><mml:mo>&#x2212;</mml:mo><mml:mfrac><mml:mrow><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:mi>a</mml:mi><mml:msub><mml:mtext>k</mml:mtext><mml:mn>1</mml:mn></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mi>b</mml:mi><mml:msub><mml:mtext>k</mml:mtext><mml:mn>2</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow></mml:mrow><mml:mrow><mml:mi>m</mml:mi><mml:msubsup><mml:mtext>v</mml:mtext><mml:mi>x</mml:mi><mml:mn>2</mml:mn></mml:msubsup></mml:mrow></mml:mfrac></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo>]</mml:mo></mml:mrow></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
</sec>
<sec id="s2_2_2">
<label>2.2.2</label>
<title>Assign initial values</title>
<p>After the initial values are assigned, the filter begins iterative calculations, as shown in <xref ref-type="fig" rid="f3"><bold>Figure&#xa0;3</bold></xref>.</p>
<fig id="f3" position="float">
<label>Figure&#xa0;3</label>
<caption>
<p>EKF algorithm flowchart.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g003.tif">
<alt-text content-type="machine-generated">Block diagram illustrating an algorithm with three sections: Initial Conditions Input, Prediction Module, and Correction Module. Each section contains mathematical equations relating to state prediction, error covariance prediction, gain calculation, measurement update, and state error covariance update. Arrows indicate process flow between modules.</alt-text>
</graphic></fig>
<p>Based on the above vehicle model and the corresponding state equations and measurement equations, design an Extended Kalman Filter (EKF), including the control variables <inline-formula>
<mml:math display="inline" id="im41"><mml:mrow><mml:mtext>&#x3bc;</mml:mtext><mml:mo>=</mml:mo><mml:msup><mml:mrow><mml:mrow><mml:mo stretchy="false">[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mi>&#x3b4;</mml:mi></mml:mtd><mml:mtd><mml:mrow><mml:msub><mml:mi>a</mml:mi><mml:mi>&#x3c7;</mml:mi></mml:msub></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo stretchy="false">]</mml:mo></mml:mrow></mml:mrow><mml:mtext>T</mml:mtext></mml:msup></mml:mrow></mml:math></inline-formula>, state variables <inline-formula>
<mml:math display="inline" id="im42"><mml:mrow><mml:mo>&#xa0;</mml:mo><mml:mi>x</mml:mi><mml:mo>=</mml:mo><mml:msup><mml:mrow><mml:mrow><mml:mo stretchy="false">[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi>r</mml:mi><mml:mo>,</mml:mo><mml:mi>&#x3b2;</mml:mi><mml:mo>,</mml:mo><mml:mi>u</mml:mi></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo stretchy="false">]</mml:mo></mml:mrow></mml:mrow><mml:mi>T</mml:mi></mml:msup></mml:mrow></mml:math></inline-formula>, output variables <inline-formula>
<mml:math display="inline" id="im43"><mml:mrow><mml:mi>y</mml:mi><mml:mo>=</mml:mo><mml:mrow><mml:mo stretchy="false">[</mml:mo><mml:mrow><mml:msub><mml:mi>a</mml:mi><mml:mi>y</mml:mi></mml:msub></mml:mrow><mml:mo stretchy="false">]</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>. Process noise covariance matrix <inline-formula>
<mml:math display="inline" id="im44"><mml:mrow><mml:mi mathvariant="script">Q</mml:mi><mml:mo>=</mml:mo><mml:msub><mml:mi>I</mml:mi><mml:mrow><mml:mn>3</mml:mn><mml:mo>&#xd7;</mml:mo><mml:mn>3</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>, measurement noise covariance matrix <inline-formula>
<mml:math display="inline" id="im45"><mml:mrow><mml:mi>R</mml:mi><mml:mo>=</mml:mo><mml:mrow><mml:mo stretchy="false">[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mn>10000</mml:mn></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo stretchy="false">]</mml:mo></mml:mrow></mml:mrow></mml:math></inline-formula>, initial value of the error covariance matrix <inline-formula>
<mml:math display="inline" id="im46"><mml:mrow><mml:msup><mml:mi>p</mml:mi><mml:mo>&#x2212;</mml:mo></mml:msup><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msub><mml:mi>t</mml:mi><mml:mn>0</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:msub><mml:mi>I</mml:mi><mml:mrow><mml:mn>3</mml:mn><mml:mo>&#xd7;</mml:mo><mml:mn>3</mml:mn></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula>,initial state values <inline-formula>
<mml:math display="inline" id="im47"><mml:mrow><mml:msup><mml:mi>x</mml:mi><mml:mo>&#x2212;</mml:mo></mml:msup><mml:mrow><mml:mo stretchy="false">(</mml:mo><mml:mrow><mml:msub><mml:mi>t</mml:mi><mml:mn>0</mml:mn></mml:msub></mml:mrow><mml:mo stretchy="false">)</mml:mo></mml:mrow><mml:mo>=</mml:mo><mml:msup><mml:mrow><mml:mrow><mml:mo stretchy="false">[</mml:mo><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mn>0</mml:mn></mml:mtd><mml:mtd><mml:mn>0</mml:mn></mml:mtd><mml:mtd><mml:mrow><mml:mn>26</mml:mn></mml:mrow></mml:mtd><mml:mtd><mml:mn>4</mml:mn></mml:mtd></mml:mtr></mml:mtable></mml:mrow><mml:mo stretchy="false">]</mml:mo></mml:mrow></mml:mrow><mml:mi>T</mml:mi></mml:msup></mml:mrow></mml:math></inline-formula>. This study determined the values of Q and R through parameter tuning based on the actual measurement data manuals and simulation system characteristics of the employed sensors (wheel speed sensors, IMU), combined with a trial-and-error approach.</p>
<p>Based on the above content, simulations were conducted. The simulation results show that when the initial adhesion coefficient is 1, the left wheel quickly converges to 0.8, while the right wheel converges to 0.3, as shown in <xref ref-type="fig" rid="f4"><bold>Figure&#xa0;4a</bold></xref>. Further simulation verification indicates that both the left and right wheels converge to 0.85, demonstrating the high accuracy of the EKF in identifying road adhesion coefficients. As shown in <xref ref-type="fig" rid="f4"><bold>Figure&#xa0;4b</bold></xref>, the blue solid line represents the true value of the road adhesion coefficient, and the orange dashed line represents the real-time estimate from the EKF algorithm.</p>
<fig id="f4" position="float">
<label>Figure&#xa0;4</label>
<caption>
<p>Road adhesion coefficient value: <bold>(a)</bold> Comparison of identification results of left and right side attachment coefficients <bold>(b)</bold> Comparison of Real Values and EKF Estimates.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g004.tif">
<alt-text content-type="machine-generated">Two line graphs labeled (a) and (b) compare the parameter &#x3bc; over time t for EKF1 through EKF4. Graph (a) shows separation into higher and lower &#x3bc; clusters, while graph (b) displays convergence among all series as t increases. Both include a key and dashed reference lines.</alt-text>
</graphic></fig>
<p>Finally, the tracking performance of the EKF under sudden changes in road adhesion coefficient was further quantified by comparing two conditions with less distinct differentiation: dry and wet road surfaces. The blue solid line represents the true value of &#x3bc;, while the orange dashed line represents the EKF estimate. The results show that during stable road conditions (t = 0-40s, dry road), the EKF estimate closely tracks the true value, with a maximum relative error of less than 5%. At t = 40 seconds, a sudden change from dry to wet road occurs, with &#x3bc; dropping from 0.85 to 0.55. The EKF demonstrates good convergence, with the error band quickly narrowing to a stable state, as shown in the global response in <xref ref-type="fig" rid="f5"><bold>Figure&#xa0;5a</bold></xref>. As illustrated in the zoomed-in view in <xref ref-type="fig" rid="f5"><bold>Figure&#xa0;5b</bold></xref>, the true road condition changes and the real-time estimate trajectory coincide until 40.15 seconds. Subsequently, the EKF detects the sudden change and initiates adaptive adjustment, showing that the algorithm rapidly converges to this accuracy range by 40.48 seconds (taking only 0.33 seconds), and finally reaches full stability at 40.63 seconds. This high-precision, fast-response real-time identification capability provides critical and reliable road condition parameter inputs for subsequent path planning and vehicle control.</p>
<fig id="f5" position="float">
<label>Figure&#xa0;5</label>
<caption>
<p>EKF road adhesion coefficient estimation performance (sudden change from dry to wet road): <bold>(a)</bold> global response <bold>(b)</bold> local magnification (mutation moment).</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g005.tif">
<alt-text content-type="machine-generated">Line chart with two panels. Panel (a) shows friction coefficient versus time, indicating a sharp drop at 40 seconds marking the dry-to-wet transition. Both ground truth (solid blue) and EKF estimate (dashed red) overlap closely. Panel (b) zooms in on 39.8 to 41.2 seconds, detailing detection delay of 0.15 seconds, convergence time of 0.33 seconds, and maximum overshoot of 12.7 percent for the EKF estimate. A performance summary box lists the detection delay, convergence time, stabilization time, and overshoot. Legend differentiates ground truth, EKF estimate, and the &#xb1;5 percent error band.</alt-text>
</graphic></fig>
</sec>
</sec>
<sec id="s2_3">
<label>2.3</label>
<title>Path tracking based on the hybrid A* algorithm</title>
<p>In autonomous driving systems, path planning and vehicle control are tightly coupled critical components. The Hybrid A* algorithm combines the efficient search capabilities of the traditional A* algorithm with the advantages of other methods (such as considering vehicle dynamic constraints), enabling the generation of feasible paths that better align with the vehicle&#x2019;s motion characteristics (<xref ref-type="bibr" rid="B7">Dolgov et&#xa0;al., 2010</xref>). The standard A* algorithm uses heuristic search to find the shortest path in a discrete graph but is less efficient in high-dimensional continuous state spaces or environments with complex constraints (<xref ref-type="bibr" rid="B10">Hart et&#xa0;al., 1968</xref>). By integrating multiple heuristic rules and directly sampling in continuous state space, Hybrid A* can provide better solutions in dynamic environments and effectively incorporate real-time road adhesion coefficient &#x3bc; information for risk assessment and path adjustment.</p>
<p>When &#x3bc; changes, the set of feasible paths and safety margins for the vehicle also change. Under low &#x3bc; conditions, planned paths need to avoid sharp turns and high-curvature sections while maintaining larger safety distances. The Hybrid A* algorithm not only needs to optimize traditional metrics such as path length or smoothness but also must evaluate path feasibility and risk by integrating real-time &#x3bc; information, dynamically adjusting planning strategies&#x2014;for example, avoiding low-&#x3bc; areas or selecting more conservative routes. The flowchart of the Hybrid A* algorithm is shown in <xref ref-type="fig" rid="f6"><bold>Figure&#xa0;6</bold></xref>.</p>
<fig id="f6" position="float">
<label>Figure&#xa0;6</label>
<caption>
<p>Flowchart of the hybrid A* algorithm.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g006.tif">
<alt-text content-type="machine-generated">Flowchart illustrating a path-planning algorithm for vehicles, starting with initialization, selecting minimum cost motion patterns, using Reeds-Shepp curves or A* algorithm, checking for obstacles, determining proximity to the goal, and outputting path points.</alt-text>
</graphic></fig>
<p>Hybrid A* can be regarded as a path planning algorithm extended from the A* framework. Its core innovation lies in the use of dual heuristic functions: one is the cost function h1(x), and the other is the heuristic function h2(x). h1(x) represents the minimum cost from the current state x to the goal state (usually considering non-holonomic constraints, dynamic constraints, etc., which makes the computation complex), while h2(x) represents an optimistic estimated cost from the current state x to the goal state (typically using simplified models such as Reeds-Shepp curves, Euclidean distance, etc., which are computationally efficient). By combining h1(x) and h2(x), the Hybrid A* algorithm can significantly reduce the search time of the A* algorithm while ensuring path quality. The specific implementation method is as follows:</p>
<list list-type="order">
<list-item>
<p>Add the starting position to the OPEN list;</p></list-item>
<list-item>
<p>When the OPEN list is a non-empty set, obtain the node with the smallest f value and move it into the CLOSE list;</p></list-item>
<list-item>
<p>Expand the current node and calculate the f value (f = g + h) for each child node, where g is the cumulative actual cost from the start node to the current child node, and h represents the heuristic value, usually taken as max(h1(x), h2(x)) or other combinations to balance feasibility and search efficiency.</p></list-item>
<list-item>
<p>If the child node already exists in the CLOSE list, then ignore this node.</p></list-item>
<list-item>
<p>If the child node already exists in the OPEN list, compare its current g-value with the previously recorded g-value. If the new g-value is smaller, update the node information.</p></list-item>
<list-item>
<p>If the child node is not only absent from the OPEN list but also does not exist in the CLOSE list, then add this child node to the OPEN list.</p></list-item>
<list-item>
<p>Repeat steps 2&#x2013;6 until the target node is found or the OPEN list is empty.</p></list-item>
</list>
<p>To quantitatively evaluate the performance advantages of the hybrid A* algorithm, this study conducted systematic comparative testing between the hybrid A* and traditional A* algorithms within identical simulation environments. The test scenario comprised a typical agricultural field area (dimensions 60 m &#xd7; 40 m) containing six static obstacles, with the start and end points situated at opposite corners of the area. The performance comparison results are as follows:</p>
<p>1. Search efficiency improved by 40%</p>
<p>The traditional A* algorithm requires an average expansion of approximately 1,850 nodes, with an average computation time of 2.8 seconds; the hybrid A* algorithm requires an average expansion of approximately 1,120 nodes, with an average computation time of 1.68 seconds. The computational efficiency is as shown in <xref ref-type="disp-formula" rid="eq15">Equation 15</xref>.</p>
<disp-formula id="eq15"><label>(15)</label>
<mml:math display="block" id="M15"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:msub><mml:mi>&#x3b7;</mml:mi><mml:mrow><mml:mtext>e</mml:mtext><mml:mi>f</mml:mi><mml:mi>f</mml:mi><mml:mi>i</mml:mi><mml:mi>c</mml:mi><mml:mi>i</mml:mi><mml:mi>e</mml:mi><mml:mi>n</mml:mi><mml:mi>c</mml:mi><mml:mi>y</mml:mi></mml:mrow></mml:msub><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>T</mml:mi><mml:mrow><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>T</mml:mi><mml:mrow><mml:mtext>H</mml:mtext><mml:mi>y</mml:mi><mml:mi>b</mml:mi><mml:mi>r</mml:mi><mml:mi>i</mml:mi><mml:mi>d</mml:mi><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>T</mml:mi><mml:mrow><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow></mml:mfrac><mml:mo>&#xd7;</mml:mo><mml:mn>100</mml:mn><mml:mo>%</mml:mo><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:mn>2.8</mml:mn><mml:mtext>&#xa0;</mml:mtext><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mn>1.68</mml:mn></mml:mrow><mml:mrow><mml:mn>2.8</mml:mn></mml:mrow></mml:mfrac><mml:mo>&#xd7;</mml:mo><mml:mn>100</mml:mn><mml:mo>%</mml:mo><mml:mo>&#x2248;</mml:mo><mml:mn>40</mml:mn><mml:mo>%</mml:mo></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>Among them, <inline-formula>
<mml:math display="inline" id="im48"><mml:mrow><mml:msub><mml:mi>T</mml:mi><mml:mrow><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula> and <inline-formula>
<mml:math display="inline" id="im49"><mml:mrow><mml:msub><mml:mi>T</mml:mi><mml:mrow><mml:mtext>H</mml:mtext><mml:mi>y</mml:mi><mml:mi>b</mml:mi><mml:mi>r</mml:mi><mml:mi>i</mml:mi><mml:mi>d</mml:mi><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow></mml:math></inline-formula> denote the average single-run planning time for the two algorithms respectively. The efficiency gain primarily stems from Hybrid A* employing dual heuristic functions h1(x) and h2(x), which converge earlier to feasible paths during node expansion, thereby reducing futile searches.</p>
<p>2. Obstacle avoidance path length increased by only 12%</p>
<p>The average path length planned by the traditional A* algorithm was 52.4 metres; the hybrid A* algorithm, designed to accommodate vehicle kinematic constraints and achieve smooth steering, yielded an average path length of 58.7 meters. The proportional increase in path length is shown in <xref ref-type="disp-formula" rid="eq16">Equation 16</xref>.</p>
<disp-formula id="eq16"><label>(16)</label>
<mml:math display="block" id="M16"><mml:mrow><mml:mtable><mml:mtr><mml:mtd><mml:mrow><mml:mi mathvariant="normal">&#x394;</mml:mi><mml:mi>L</mml:mi><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:msub><mml:mi>L</mml:mi><mml:mrow><mml:mtext>H</mml:mtext><mml:mi>y</mml:mi><mml:mi>b</mml:mi><mml:mi>r</mml:mi><mml:mi>i</mml:mi><mml:mi>d</mml:mi></mml:mrow></mml:msub><mml:mtext>&#xa0;</mml:mtext><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:msub><mml:mi>L</mml:mi><mml:mrow><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow><mml:mrow><mml:msub><mml:mi>L</mml:mi><mml:mrow><mml:msup><mml:mi>A</mml:mi><mml:mo>&#x2217;</mml:mo></mml:msup></mml:mrow></mml:msub></mml:mrow></mml:mfrac><mml:mo>&#xd7;</mml:mo><mml:mn>100</mml:mn><mml:mo>%</mml:mo><mml:mo>=</mml:mo><mml:mfrac><mml:mrow><mml:mn>58.7</mml:mn><mml:mtext>&#xa0;</mml:mtext><mml:mo>&#x2212;</mml:mo><mml:mtext>&#xa0;</mml:mtext><mml:mn>52.4</mml:mn></mml:mrow><mml:mrow><mml:mn>52.4</mml:mn></mml:mrow></mml:mfrac><mml:mo>&#xd7;</mml:mo><mml:mn>100</mml:mn><mml:mo>%</mml:mo><mml:mo>&#x2248;</mml:mo><mml:mn>12</mml:mn><mml:mo>%</mml:mo></mml:mrow></mml:mtd></mml:mtr></mml:mtable></mml:mrow></mml:math>
</disp-formula>
<p>This increase in length is primarily attributable to the hybrid A* algorithm, which incorporates steering continuity constraints and path smoothing. This approach mitigates the abrupt turns and path jitter inherent in traditional A*, better aligning with the actual motion characteristics of vehicles. Consequently, while ensuring path feasibility, it achieves a modest extension of the travel distance.</p>
<p>3. Replanning response time&lt; 0.1 seconds</p>
<p>In dynamic obstacle testing scenarios (simulating sudden moving obstacles encountered in the field), the system triggers its replanning mechanism. Simulation records indicate that the average time from obstacle detection to completion of new path generation is 0.086 seconds, with a standard deviation of 0.015 seconds, meeting real-time requirements (&lt;0.1 seconds). This performance is primarily attributable to the hybrid A* algorithm&#x2019;s mechanism for locally refining existing paths, coupled with the effective guidance provided by the heuristic function.</p>
<p>Finally, comparisons were conducted with three typical planning algorithms: the traditional A* algorithm, Dijkstra&#x2019;s algorithm, and the Rapidly Exploring Random Tree (RRT) algorithm. Comparison metrics included planning time, path length, path smoothness (mean curvature), and number of nodes searched. The results are presented in <xref ref-type="table" rid="T2"><bold>Table&#xa0;2</bold></xref>.</p>
<table-wrap id="T2" position="float">
<label>Table&#xa0;2</label>
<caption>
<p>Performance comparison of path planning algorithms.</p>
</caption>
<table frame="hsides">
<thead>
<tr>
<th valign="middle" align="center">Algorithm</th>
<th valign="middle" align="center">Average planning time (s)</th>
<th valign="middle" align="center">Average path length (m)</th>
<th valign="middle" align="center">Average curvature (1/m)</th>
<th valign="middle" align="center">Average search node count</th>
</tr>
</thead>
<tbody>
<tr>
<td valign="middle" align="center">Hybrid A*</td>
<td valign="middle" align="center">1.68</td>
<td valign="middle" align="center">58.7</td>
<td valign="middle" align="center">0.028</td>
<td valign="middle" align="center">1120</td>
</tr>
<tr>
<td valign="middle" align="center">TraditionalA*</td>
<td valign="middle" align="center">2.80</td>
<td valign="middle" align="center">52.4</td>
<td valign="middle" align="center">0.041</td>
<td valign="middle" align="center">1850</td>
</tr>
<tr>
<td valign="middle" align="center">Dijkstra</td>
<td valign="middle" align="center">4.15</td>
<td valign="middle" align="center">53.1</td>
<td valign="middle" align="center">0.045</td>
<td valign="middle" align="center">2200</td>
</tr>
<tr>
<td valign="middle" align="center">RRT</td>
<td valign="middle" align="center">0.95</td>
<td valign="middle" align="center">62.3</td>
<td valign="middle" align="center">0.025</td>
<td valign="middle" align="center">&#x2013;</td>
</tr>
</tbody>
</table>
</table-wrap>
<p>Comparative analysis indicates that Hybrid A* achieves a 40% improvement in planning time over traditional A*, and approximately 60% over Dijkstra&#x2019;s algorithm. Whilst slightly slower than RRT, it delivers markedly superior path quality. Regarding path length, Hybrid A* increases by only 12% compared to traditional A*, and is significantly shorter than RRT (62.3 m). Path smoothness (mean curvature) surpasses both traditional A* and Dijkstra&#x2019;s algorithms, approaching RRT levels. The number of searched nodes is reduced by approximately 40% compared to traditional A*, demonstrating the efficiency advantage of dual heuristics.</p>
<p>In summary, Hybrid A* achieves a favorable balance between planning efficiency, path quality, and driving smoothness. It is particularly well-suited for operational tasks in agricultural settings demanding high real-time performance, safety, and driving stability.</p>
<p>Based on the above content, this paper uses the hybrid A* algorithm for path planning to enable the unmanned harvester to automatically find the optimal path during operation. As shown in <xref ref-type="fig" rid="f7"><bold>Figure&#xa0;7a</bold></xref>, the obstacles are marked with asterisks, with the red asterisks indicating the start and end points. The nodes explored by the algorithm during the search for the optimal path are connected by red lines. <xref ref-type="fig" rid="f7"><bold>Figure&#xa0;7b</bold></xref> shows the optimal path planned by the hybrid A* algorithm. Simulation results demonstrate that the hybrid A* algorithm successfully plans an optimal (or feasible) path that avoids all obstacles. This result validates the effectiveness of the hybrid A* algorithm in complex static farmland environments. More importantly, the algorithm framework has the potential to integrate real-time road adhesion coefficient &#x3bc; information, allowing dynamic adjustment of the path cost function based on road conditions to select safer and more feasible paths. This enhances the system&#x2019;s adaptability and safety in dynamic farmland environments, showcasing its application potential in the field of agricultural automation.</p>
<fig id="f7" position="float">
<label>Figure&#xa0;7</label>
<caption>
<p><bold>(a)</bold> Hybrid A* path planning results. <bold>(b)</bold> Hybrid A* planning for optimal path.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g007.tif">
<alt-text content-type="machine-generated">Two grid-based plots compare pathfinding algorithms through obstacle fields marked by asterisks. Panel (a) features a purple route between two red stars, showing a winding path. Panel (b) has a more direct blue route between red stars, navigating differently through clustered obstacles. Both axes are labeled &#x201c;m&#x201d; and span zero to thirty-five.</alt-text>
</graphic></fig>
</sec>
<sec id="s2_4">
<label>2.4</label>
<title>Virtual vehicle full-vehicle dynamics modeling</title>
<p>Whole vehicle modeling is a key step in vehicle dynamic simulation, primarily involving the modeling of sprung mass and unsprung mass. Sprung mass modeling includes parameters such as the vehicle body dimensions, center of gravity location, and moments of inertia, all of which significantly affect the vehicle&#x2019;s stability and handling. Unsprung mass focuses on components not directly supported by the suspension system, such as the wheels, drive shafts, and braking system, and is related to parameters like the front and rear track widths and the wheels&#x2019; moments of inertia. The virtual vehicle prototype used in this simulation is the Suzhou King Long KLQ6125D series bus, with a curb weight of 5,025 kg, to align with the actual test vehicle, the mass and inertia parameters of this model have been scaled and adjusted in accordance with the equivalence principle outlined in Section 2.1, thereby simulating the target harvester&#x2019;s dynamic characteristics, of which 4,455 kg is sprung mass and 570 kg is unsprung mass. The unsprung mass and parameters such as the front and rear track widths will be integrated with the suspension system modeling to ensure that the dynamic simulation results align with the actual vehicle performance.</p>
<p>Tires are an important component in vehicle dynamics analysis, as tire characteristics directly affect a vehicle&#x2019;s power performance, braking, handling stability, ride comfort, and safety. In TruckSim, tire modeling mainly includes the tire&#x2019;s geometric dimensions, steady-state mechanical characteristics, transient response characteristics, and dynamic hysteresis losses (<xref ref-type="bibr" rid="B27">Svendenius, 2007</xref>). Among these, the most critical aspect is the modeling of tire mechanical characteristics. This part of the modeling can be based on experimental data or can use empirical or semi-empirical tire models through parameter settings. Tire mechanical characteristics include longitudinal force, lateral force, and self-aligning torque. Accurate tire characteristics are essential to correctly reflect the vehicle&#x2019;s state during simulation. This paper uses the Magic Formula tire model to model this tire type, as shown in <xref ref-type="fig" rid="f8"><bold>Figure&#xa0;8</bold></xref>. This modeling approach is simple and can represent the tire&#x2019;s mechanical characteristics both under pure conditions and combined conditions (<xref ref-type="bibr" rid="B22">Pacejka, 2012</xref>).</p>
<fig id="f8" position="float">
<label>Figure&#xa0;8</label>
<caption>
<p>Characteristics of the magic formula tire model.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g008.tif">
<alt-text content-type="machine-generated">Tire modeling interface displaying settings for vertical force, rolling resistance, shear forces, and moments, along with input fields for specific parameters such as tire width, inertia, radius, and spring rate. A diagram illustrates force and moment axes at the tire contact center. A chart shows tire force versus distance rolled. Several drop-down menus and data input sections manage tire dynamics and contact patch dimensions.</alt-text>
</graphic></fig>
<p>Further analysis of the rationality is presented in <xref ref-type="fig" rid="f9"><bold>Figure&#xa0;9</bold></xref>. <xref ref-type="fig" rid="f9"><bold>Figure&#xa0;9a</bold></xref> shows the longitudinal force characteristics of the tire, which are the most comparable equivalent characteristics to those of the track. The track system also exhibits a &#x201c;slip ratio - traction force&#x201d; relationship curve with a similar shape. <xref ref-type="fig" rid="f9"><bold>Figure&#xa0;9b</bold></xref> illustrates the longitudinal force under combined slip; this 3D surface plot demonstrates how the longitudinal force diminishes when both longitudinal slip and slip angle are present simultaneously. In other words, during acceleration while turning, the effectiveness of the driving force is affected, which conceptually can be considered equivalent to the track characteristics.</p>
<fig id="f9" position="float">
<label>Figure&#xa0;9</label>
<caption>
<p>Theoretical tire model: <bold>(a)</bold> longitudinal force of the lower tire under pure longitudinal slip <bold>(b)</bold> longitudinal force of tire under combined slip.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g009.tif">
<alt-text content-type="machine-generated">Graph (a) presents a line chart illustrating longitudinal force versus longitudinal slip ratio for varying normal loads from one thousand to four thousand kilograms, with higher loads yielding greater force. Graph (b) is a three-dimensional surface plot showing longitudinal force as a function of both slip angle and slip ratio under combined slip conditions.</alt-text>
</graphic></fig>
<p>The road environment settings are used to simulate common driving scenarios for vehicles, including straight roads, lane changes, curves, uphill climbs, and complex conditions such as slippery surfaces. In TruckSim, three-dimensional road surfaces can be created, allowing users to freely set road elevation, lateral and longitudinal slopes, and customize road shapes like sharp curves and gentle bends to realistically simulate various road environments. Additionally, TruckSim allows adjustment of the road adhesion coefficient to simulate hazardous conditions with low adhesion, especially under extreme road conditions such as icy or wet surfaces. In the road settings, it is also possible to create two-way roads or joint road surfaces for analyzing vehicle braking performance.</p>
<p>Other systems, such as the steering system and suspension system, will not be elaborated on in this text.</p>
</sec>
<sec id="s2_5">
<label>2.5</label>
<title>Lane keeping based on PID algorithm</title>
<p>The output of path planning is the desired path (or trajectory), while lane-keeping control is the key execution layer for achieving precise path tracking. The lane-keeping system proposed in this paper combines a PID controller with a hybrid A* planned path to ensure stable operation of an unmanned harvester in complex agricultural environments. The PID controller makes real-time adjustments based on the lateral deviation (e) between the vehicle&#x2019;s current position and the desired path (the lane center reference line), outputting front wheel steering angle commands (<inline-formula>
<mml:math display="inline" id="im50"><mml:mrow><mml:msub><mml:mi>&#x3b4;</mml:mi><mml:mo>_</mml:mo></mml:msub><mml:mtext>cmd</mml:mtext></mml:mrow></mml:math></inline-formula>) to enable the vehicle to follow the reference path (<xref ref-type="bibr" rid="B20">Ogata, 2010</xref>). This control process dynamically incorporates the real-time identified road adhesion coefficient &#x3bc;, for example, increasing control margins or limiting maximum steering angle/acceleration under low &#x3bc; conditions.</p>
<p>In this paper, the function of the PID controller is to calculate a new steering adjustment by using the vehicle&#x2019;s lateral deviation as a feedback signal. Specifically, the PID controller continuously computes the lateral deviation and adjusts the steering angle magnitude to gradually reduce the vehicle&#x2019;s distance from the lane. When the vehicle deviates significantly from the lane, the PID controller increases the steering angle to quickly guide the vehicle back to the lane center; when the vehicle is close to the lane center, the PID controller reduces the steering adjustment to avoid overcorrection. The feedback loop is the core part of this system&#x2014;the feedback signal (i.e., lateral distance) is continuously fed back to the PID controller, and the system ensures the vehicle remains centered in the lane by real-time steering adjustments. The PID parameters of the controller were determined through a systematic process: first, baseline parameters were obtained using the Ziegler-Nichols method based on the vehicle lateral dynamics model; subsequently, within the TruckSim/Simulink co-simulation environment, fine-tuning was performed for typical farmland scenarios (straight lines, bends) via trial-and-error, targeting minimization of the integral absolute error; Finally, parameter sensitivity analysis (<xref ref-type="fig" rid="f10"><bold>Figure&#xa0;10</bold></xref>) validated the optimality of the selected parameter combination (Kp=1.2, Ki=0.05, Kd=0.12) under the specified operating conditions.</p>
<fig id="f10" position="float">
<label>Figure&#xa0;10</label>
<caption>
<p>PID parameter sensitivity analysis.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g010.tif">
<alt-text content-type="machine-generated">Contour plot visualizes control performance as a function of proportional gain (Kp) on the X-axis and derivative gain (Kd) on the Y-axis, with colors indicating performance levels. Optimal parameters are marked with a red dot at Kp equals 1.21 and Kd equals 0.12, where performance is highest according to the labeled color scale on the right.</alt-text>
</graphic></fig>
<p>In addition, the system may also use some mathematical transformations (such as the sine and cosine functions of trigonometry) to describe the geometric relationship between the vehicle&#x2019;s position and steering angle, making the PID controller&#x2019;s response more precise and efficient. Ultimately, the PID controller finely adjusts the steering angle, allowing the vehicle to smoothly stay within the lane and avoid drifting out of it.</p>
<p>The performance of the PID controller is highly dependent on parameter tuning. The sensitivity analysis in <xref ref-type="fig" rid="f10"><bold>Figure&#xa0;10</bold></xref> reveals key patterns: 1) When the proportional gain Kp = 1.2 and the derivative gain Kd = 0.12 (marked by the red point), the control performance reaches its peak (deep yellow region); 2) Changes in the derivative gain Kd have a more significant impact on system stability (contour lines are denser), indicating that during real vehicle debugging, priority should be given to ensuring the accuracy of the derivative term. Based on this analysis, this study sets the PID controller parameters to Kp = 1.2, Ki = 0.05, and Kd = 0.12, laying the foundation for subsequent lane-keeping control.</p>
<p>In the Simulink environment, a complete PID controller model can be constructed. The model&#x2019;s input is typically the vehicle&#x2019;s lateral deviation, while the output is the steering command <inline-formula>
<mml:math display="inline" id="im51"><mml:mrow><mml:msub><mml:mi>&#x3b4;</mml:mi><mml:mo>_</mml:mo></mml:msub><mml:mtext>cmd</mml:mtext></mml:mrow></mml:math></inline-formula>. To better simulate real driving conditions, the model also needs to incorporate the vehicle&#x2019;s dynamic characteristics, including the position of the vehicle&#x2019;s center of gravity, moment of inertia, and tire properties. To further validate and optimize the PID controller&#x2019;s performance, this study integrates simulation with TruckSim software. TruckSim can simulate vehicle behavior under real road conditions, receiving control signals output from Simulink and providing feedback on the vehicle&#x2019;s actual driving state. By coordinating these two tools, the effectiveness of the PID controller can be efficiently tested in a virtual environment, avoiding potential safety risks associated with real-world road testing.</p>
</sec>
</sec>
<sec id="s3">
<label>3</label>
<title>Experimental results and discussion</title>
<sec id="s3_1">
<label>3.1</label>
<title>Vehicle simulation testing and analysis</title>
<p>The vehicle model parameters used in the simulation process are consistent with those of the actual vehicle. The simulation model is shown in <xref ref-type="fig" rid="f11"><bold>Figure&#xa0;11</bold></xref>. Other simulation parameters are listed in <xref ref-type="table" rid="T3"><bold>Table&#xa0;3</bold></xref>.</p>
<fig id="f11" position="float">
<label>Figure&#xa0;11</label>
<caption>
<p>Simulation model diagram.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g011.tif">
<alt-text content-type="machine-generated">Block diagram in a simulation environment showing interconnected components, signals, and processing units. Central block labeled &#x201c;vs_sf&#x201d; with a green vehicle icon indicates a system model, surrounded by logic, math, and output nodes for parameters such as [X], [Y], [Vx], and [Vy].</alt-text>
</graphic></fig>
<table-wrap id="T3" position="float">
<label>Table&#xa0;3</label>
<caption>
<p>Simulation parameter setting.</p>
</caption>
<table frame="hsides">
<thead>
<tr>
<th valign="middle" align="center">Parameter</th>
<th valign="middle" align="center">Value</th>
</tr>
</thead>
<tbody>
<tr>
<td valign="middle" align="center">Simulation step size T</td>
<td valign="middle" align="center">0.25s</td>
</tr>
<tr>
<td valign="middle" align="center">Simulation time</td>
<td valign="middle" align="center">120s</td>
</tr>
<tr>
<td valign="middle" align="center">Initial velocity</td>
<td valign="middle" align="center">0m/s</td>
</tr>
<tr>
<td valign="middle" align="center">Initial lateral deviation</td>
<td valign="middle" align="center">0m</td>
</tr>
<tr>
<td valign="middle" align="center">Initial heading deviation</td>
<td valign="middle" align="center">0&#xb0;</td>
</tr>
</tbody>
</table>
</table-wrap>
<p><xref ref-type="fig" rid="f12"><bold>Figure&#xa0;12</bold></xref> intuitively demonstrates the core performance of the PID controller in path tracking. Over the 120-second simulation period, the actual driving trajectory (red solid line) closely follows the reference path (blue dashed line). Even in the complex S-curve section between t=30 and 50 seconds, the maximum lateral deviation of the actual path is only 0.12 meters, consistently maintained within the &#xb1;0.15 meter safety margin (light blue shaded area). During the curved section (approximately X = 25&#x2013;35 m), the vehicle trajectory shows slight overshoot but quickly converges back to the reference path, demonstrating the controller&#x2019;s robustness.</p>
<fig id="f12" position="float">
<label>Figure&#xa0;12</label>
<caption>
<p>Path tracking performance under PID control.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g012.tif">
<alt-text content-type="machine-generated">Line graph comparing reference path and actual path of lateral position in meters over time in seconds, showing both paths closely follow a sinusoidal pattern with minor deviations in the actual path.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f13"><bold>Figure&#xa0;13</bold></xref> shows the trajectory of the lane-keeping system, indicating that the vehicle adjusts its path through a PID controller to stay centered in the lane. In practical applications, the PID controller makes real-time adjustments based on the vehicle&#x2019;s angle or distance of deviation from the lane, ensuring lateral stability. The paths in the figure demonstrate how the vehicle drives smoothly under different conditions. The trajectory presents a relatively stable driving path, indicating that the system can effectively adjust the vehicle&#x2019;s direction to prevent it from drifting out of the lane.</p>
<fig id="f13" position="float">
<label>Figure&#xa0;13</label>
<caption>
<p>Lane keeping system trajectory.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g013.tif">
<alt-text content-type="machine-generated">Line graph showing a closed, looping path with multiple curves and turns, labeled in meters on both axes. The track-like shape spans from about negative one hundred fifty to positive three hundred on the horizontal axis and negative two hundred to one hundred twenty on the vertical axis.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f14"><bold>Figure&#xa0;14</bold></xref> shows the vehicle&#x2019;s speed. The speed curve exhibits minor fluctuations, indicating that the vehicle maintains a relatively stable speed during path adjustments. This is key to the PID controller ensuring smooth driving while keeping the vehicle within the lane. Although there are some speed variations, they remain within an acceptable range, demonstrating that the vehicle&#x2019;s lateral stability and longitudinal control work in coordination. The coordination between speed and path planning ensures the vehicle&#x2019;s adaptability under different operating conditions.</p>
<fig id="f14" position="float">
<label>Figure&#xa0;14</label>
<caption>
<p>Real-time vehicle speed curve.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g014.tif">
<alt-text content-type="machine-generated">Line graph titled &#x201c;Vx&#x201d; showing velocity in meters per second on the y-axis and time in seconds on the x-axis, with pronounced recurring spikes above a baseline centered near 50 meters per second.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f15"><bold>Figure&#xa0;15</bold></xref> shows the changes in the vehicle&#x2019;s steering angle, which fluctuate quite dramatically. These fluctuations are caused by the PID controller adjusting the steering angle to minimize the vehicle&#x2019;s deviation from the center of the lane. Specifically, when the vehicle is far from the lane center, the PID controller increases the steering angle to quickly guide the vehicle back to the lane center; when the vehicle is close to the lane center, the PID controller reduces the amount of steering adjustment to avoid overcorrection. The changes in the steering angle reflect the PID controller&#x2019;s fine-tuned adjustments to the vehicle&#x2019;s behavior.</p>
<fig id="f15" position="float">
<label>Figure&#xa0;15</label>
<caption>
<p>Vehicle steering angle change.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g015.tif">
<alt-text content-type="machine-generated">Line graph with the y-axis labeled deg ranging from negative two hundred to three hundred and the x-axis labeled t in seconds from zero to two thousand, showing a periodic signal with sharp, irregular spikes and fluctuating values.</alt-text>
</graphic></fig>
<p>By combining lane-keeping trajectories with vehicle speed and steering angle data, the effective application of the PID controller in the lane-keeping system can be observed. Fluctuations in speed and steering angle indicate that the PID controller can quickly respond to the vehicle drifting out of the lane and maintain the vehicle within the lane by adjusting the steering angle. Although the steering adjustments are relatively frequent, this also demonstrates the control system&#x2019;s efficiency and flexibility in handling dynamic environments and complex paths. The lane-keeping trajectory shown in the image illustrates how the PID controller keeps the vehicle stable under various conditions while minimizing deviation to the greatest extent. For future research, PID controller parameters can be further optimized to explore how to improve the system&#x2019;s robustness and adaptability in more complex environmental conditions. Additionally, integrating other control methods, such as Model Predictive Control (MPC) or Deep Reinforcement Learning (DRL), could be considered to further enhance the system&#x2019;s performance and stability.</p>
<p>Further analyzing the control errors, <xref ref-type="fig" rid="f16"><bold>Figure&#xa0;16</bold></xref> reveals the system&#x2019;s performance characteristics under different road conditions: 1) On dry pavement (green background, 0-40s), the lateral error remains stable below 0.05m, and the heading error is less than 1&#xb0;; 2) On wet pavement (blue background, 40-80s), the lateral error slightly increases to 0.08m, with a peak heading error of 1.8&#xb0;; 3) On muddy pavement (brown background, 80-120s), the control challenge is greatest, with lateral errors reaching up to 0.1m and peak heading errors of 2.5&#xb0;. This trend of increasing errors as the road adhesion coefficient decreases highlights the necessity of integrating an EKF-based real-time road condition recognition for control compensation.</p>
<fig id="f16" position="float">
<label>Figure&#xa0;16</label>
<caption>
<p>Control error analysis.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g016.tif">
<alt-text content-type="machine-generated">Line graph showing lateral error and yaw error over time in seconds, with colored background bands indicating alternating surface conditions: dry (green), wet (blue), and muddy (pink). Error values range from negative eighty to eighty.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f17"><bold>Figure&#xa0;17</bold></xref> illustrates the control system&#x2019;s coordinated response to steering commands and speed: 1) The steering angle response (top graph) shows significant peaks (about &#xb1;8&#xb0;) at t=30s and t=90s, corresponding to sharp turn commands in the path; 2) The speed response (bottom graph) demonstrates intelligent coordination with steering demands&#x2014;when the steering angle increases (e.g., at t=30s), the speed automatically decreases from 1.8 m/s to 1.3 m/s (a reduction of about 28%), effectively reducing the risk of skidding; during straight segments (e.g., at t=60s), the speed returns to the optimal operating speed of 1.8 m/s. This negatively correlated coordination mechanism is key to ensuring vehicle stability.</p>
<fig id="f17" position="float">
<label>Figure&#xa0;17</label>
<caption>
<p>Coordinated response of steering and speed control during path tracking.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g017.tif">
<alt-text content-type="machine-generated">Two line graphs display data over time. The top graph shows steering angle in degrees, oscillating smoothly between minus ten and plus ten. The bottom graph shows velocity in meters per second, fluctuating between approximately one point two and one point eight. Both graphs use time in seconds on the x-axis, ranging from zero to one hundred twenty.</alt-text>
</graphic></fig>
<p>To comprehensively evaluate the system&#x2019;s performance across spatiotemporal dimensions, <xref ref-type="fig" rid="f18"><bold>Figure&#xa0;18</bold></xref> presents a unique three-dimensional trajectory perspective: 1) Spatial dimension (x-y plane): The actual trajectory (red curve) and the reference path (blue dashed line) projections highly overlap, visually demonstrating path tracking accuracy; 2) Temporal dimension (x-axis): The continuous control process over the full 120-second operation cycle is fully displayed; 3) Performance dimension (z-axis): The tracking error height (z-value) clearly quantifies control deviations, with green points (dry road surface) generally showing z-values below 0.03 m, while brown points (muddy road surface) rise to 0.05-0.08 m; 4) Key phenomenon: At t = 60 s, when the road condition abruptly changes from dry (green points) to wet (blue points), the error height (z) exhibits a brief spike (around 0.07 m). However, thanks to the EKF&#x2019;s rapid detection and the PID controller&#x2019;s real-time compensation, the error quickly converges within 0.5 seconds (indicated by the purple arrow). This multi-perspective analysis validates the system&#x2019;s adaptability and robustness in dynamic farmland environments.</p>
<fig id="f18" position="float">
<label>Figure&#xa0;18</label>
<caption>
<p>3D trajectory and error visualization.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g018.tif">
<alt-text content-type="machine-generated">Three-dimensional line graph comparing reference path to actual trajectory over time with lateral position on the Y axis; trajectory points are color-coded for dry, wet, and muddy conditions, legend included.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f19"><bold>Figure&#xa0;19</bold></xref>&#x2019;s violin plots quantify the distribution characteristics of lateral errors under different road surface conditions: 1) Dry surface (left) shows the most concentrated error distribution (narrow waist), with 95% of errors falling within the 0.02-0.06 m range (box range); 2) Wet surface (middle) has a slightly wider distribution, with errors mainly between 0.04-0.08 m; 3) Muddy surface (right) exhibits the most dispersed distribution (wide belly), with error range expanding to 0.03-0.12 m, and extreme values at the ends of the whiskers reaching 0.15 m. The statistical results indicate that the system meets the agricultural operation standard of lateral error &#x2264; 0.1 m in the vast majority of conditions (95%). The control system demonstrates optimal stability on dry surfaces (with concentrated distribution), while exhibiting the widest error range on muddy roads. This phenomenon primarily stems from the nonlinear intensification of tire force saturation under low adhesion conditions, which makes vehicle response to steering inputs more unpredictable and increases control complexity. Furthermore, vehicle vibrations caused by road surface irregularities under low adhesion conditions significantly exacerbate tracking precision interference.</p>
<fig id="f19" position="float">
<label>Figure&#xa0;19</label>
<caption>
<p>Lateral error statistical distribution.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g019.tif">
<alt-text content-type="machine-generated">Violin plot comparing lateral error in meters for dry, wet, and muddy surfaces, with each surface represented by a different color and showing spread, mean, and whiskers for lateral error distribution.</alt-text>
</graphic></fig>
</sec>
<sec id="s3_2">
<label>3.2</label>
<title>Field experiment and analysis</title>
<p>After completing the simulation validation, a detailed field test deployment plan was developed to further evaluate the performance of the proposed algorithm in real-world conditions. The test plan includes selecting an appropriate test site--a test field located in Shuangfeng County, Loudi City, Hunan Province--to ensure safety and controllability. The vehicle employed in the experiment was the Nongjiapan 4LZ-1.5A full-feed crawler combine harvester, with a total mass of 1200 kg (see <xref ref-type="table" rid="T4"><bold>Table&#xa0;4</bold></xref>). This mass parameter was essentially consistent with the equivalent scaled mass parameter (1250 kg) in the simulation model, exhibiting an error margin within 4.2%. This ensured comparability between simulation and experiment in terms of inertial characteristics. The vehicle will be equipped with necessary sensors such as the Intel RealSense D415 depth camera, an IMU (Inertial Measurement Unit) for real-time measurement of the vehicle&#x2019;s three-axis acceleration, angular velocity, roll/pitch angles, and an RTK dual-antenna system for real-time differential data output (<xref ref-type="bibr" rid="B8">Fan et&#xa0;al., 2019</xref>), among others, to monitor trajectory, speed, and steering angle data in real time. Sensor configuration parameters are listed in <xref ref-type="table" rid="T5"><bold>Table&#xa0;5</bold></xref>. The picture of the whole machine is shown in <xref ref-type="fig" rid="f20"><bold>Figure&#xa0;20</bold></xref>. The testing will be conducted in phases: initially verifying the system&#x2019;s basic functions under simple conditions (such as straight lanes), then gradually progressing to more complex scenarios like curves and obstacles (referring here to field ridges) to assess the robustness and response speed of the PID controller. Data collection will cover different road adhesion coefficient (such as dry, wet, and muddy low-friction conditions) and will be compared and analyzed against simulation results. Additionally, the deployment plan incorporates safety protocols, including emergency braking mechanisms and a remote monitoring system, to ensure the safety of both the vehicle and personnel during testing. Actual operations will be carried out in rice paddies following typical harvesting paths (such as rectangular loops) with autonomous driving, evaluating the system&#x2019;s overall performance and reliability in real crop environments and during extended operation periods.</p>
<table-wrap id="T4" position="float">
<label>Table&#xa0;4</label>
<caption>
<p>Specific parameter adjustment table.</p>
</caption>
<table frame="hsides">
<thead>
<tr>
<th valign="middle" align="left">Parameter category</th>
<th valign="middle" align="left">Target harvester</th>
<th valign="middle" align="left">Simulation model</th>
<th valign="middle" align="left">Pantograph ratio</th>
<th valign="middle" align="left">Equivalent method</th>
</tr>
</thead>
<tbody>
<tr>
<td valign="middle" align="left">Total machine weight (kg)</td>
<td valign="middle" align="center">1200</td>
<td valign="middle" align="center">1250</td>
<td valign="middle" align="center">1.042</td>
<td valign="middle" align="left">Direct scaling</td>
</tr>
<tr>
<td valign="middle" align="left">Moment of Inertia: <italic>Iz</italic> (kg&#xb7;m&#xb2;)</td>
<td valign="middle" align="center">1800</td>
<td valign="middle" align="center">1950</td>
<td valign="middle" align="center">1.083</td>
<td valign="middle" align="left">Inertial equivalence</td>
</tr>
<tr>
<td valign="middle" align="left">Wheelbase (m)</td>
<td valign="middle" align="center">2.0</td>
<td valign="middle" align="center">2.2</td>
<td valign="middle" align="center">1.100</td>
<td valign="middle" align="left">Geometric similarity</td>
</tr>
<tr>
<td valign="middle" align="left">Wheelbase/Gauge (m)</td>
<td valign="middle" align="center">0.71</td>
<td valign="middle" align="center">0.70</td>
<td valign="middle" align="center">0.986</td>
<td valign="middle" align="left">Direct mapping</td>
</tr>
<tr>
<td valign="middle" align="left">lateral stiffness (N/rad)</td>
<td valign="middle" align="center">Estimated at 7&#xd7;10<sup>4</sup></td>
<td valign="middle" align="center">8&#xd7;10<sup>4</sup>N/rad</td>
<td valign="middle" align="center">1.143</td>
<td valign="middle" align="left">Force amplification</td>
</tr>
<tr>
<td valign="middle" align="left">Longitudinal stiffness (N)</td>
<td valign="middle" align="center">Estimated at 1&#xd7;10<sup>5</sup></td>
<td valign="middle" align="center">1.2&#xd7;10<sup>5</sup>N</td>
<td valign="middle" align="center">1.200</td>
<td valign="middle" align="left">Force amplification</td>
</tr>
</tbody>
</table>
</table-wrap>
<table-wrap id="T5" position="float">
<label>Table&#xa0;5</label>
<caption>
<p>Sensor configuration parameters.</p>
</caption>
<table frame="hsides">
<thead>
<tr>
<th valign="middle" align="center">Sensors</th>
<th valign="middle" align="center">Installation location</th>
<th valign="middle" colspan="2" align="center">Measurement accuracy</th>
<th valign="middle" align="center">Update frequency (Hz)</th>
</tr>
</thead>
<tbody>
<tr>
<td valign="middle" align="center">IntelRealsenseD415</td>
<td valign="middle" align="center">Directly above the vehicle body</td>
<td valign="middle" colspan="2" align="center">0.03m/&#xb0;</td>
<td valign="middle" align="center">30</td>
</tr>
<tr>
<td valign="middle" rowspan="2" align="center">IMU</td>
<td valign="middle" rowspan="2" align="center">Center of the vehicle body</td>
<td valign="middle" align="center">Gyroscope Range</td>
<td valign="middle" align="center">&#xb1;300&#xb0;/s</td>
<td valign="middle" rowspan="2" align="center">100</td>
</tr>
<tr>
<td valign="middle" align="center">Accelerometer Range</td>
<td valign="middle" align="center">&#xb1;6g</td>
</tr>
<tr>
<td valign="middle" rowspan="3" align="center">RTK-GPS</td>
<td valign="middle" rowspan="3" align="center">Roof</td>
<td valign="middle" align="center">Dual-Antenna Positioning Accuracy</td>
<td valign="middle" align="center">0.1&#xb0;/1m baseline</td>
<td valign="middle" rowspan="3" align="center">20</td>
</tr>
<tr>
<td valign="middle" align="center">Velocity Accuracy</td>
<td valign="middle" align="center">0.03m/s</td>
</tr>
<tr>
<td valign="middle" align="center">PPS Accuracy</td>
<td valign="middle" align="center">20ns</td>
</tr>
</tbody>
</table>
</table-wrap>
<fig id="f20" position="float">
<label>Figure&#xa0;20</label>
<caption>
<p>Whole equipment: <bold>(a)</bold> IntelRealsense D415 <bold>(b)</bold> IMU unit <bold>(c)</bold> Surveillance camera <bold>(d)</bold> Network Receiver <bold>(e)</bold> GNSS antennas <bold>(f)</bold> PC <bold>(g)</bold> Encoder.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g020.tif">
<alt-text content-type="machine-generated">A labeled diagram shows an orange agricultural vehicle in a field with blue arrows indicating locations and connections for an Intel Realsense D415 depth camera, IMU unit, surveillance camera, network receiver, GNSS antenna, encoder, and PC, each displayed in individual inset images.</alt-text>
</graphic></fig>
<p>As shown in <xref ref-type="fig" rid="f21"><bold>Figure&#xa0;21</bold></xref>, the lateral error on dry, flat farmland varies over time. The error starts at 0.15 meters, then quickly decreases and stabilizes around 0.05 meters after the controller adjustment, remaining consistently below the 0.1-meter safety threshold. This verifies the stability of the PID control under simple conditions.</p>
<fig id="f21" position="float">
<label>Figure&#xa0;21</label>
<caption>
<p>Straight-line path tracking performance.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g021.tif">
<alt-text content-type="machine-generated">Line graph showing lateral error in meters versus time in seconds, with a blue line trending downward and fluctuating below the red dashed safety threshold of 0.1 meters within a shaded green safe zone.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f22"><bold>Figure&#xa0;22</bold></xref> shows the changes in steering angle, speed, and lateral error during an upcoming turn at a field ridge. The steering angle reaches its peak (&#xb1; 8&#xb0;) at the curve, while the speed correspondingly decreases (from 1.8 m/s to 1.3 m/s), demonstrating the steering-speed coordination mechanism. The lateral error slightly increases at the curve (up to 0.1 m) but remains within a safe range. The control signals (steering angle and velocity) are filtered by a low-pass filter (cut-off frequency 2 Hz) to represent the low-frequency vehicle dynamics. The measured lateral error is raw data.</p>
<fig id="f22" position="float">
<label>Figure&#xa0;22</label>
<caption>
<p>Curve steering - speed coordination test.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g022.tif">
<alt-text content-type="machine-generated">Line graph showing three data series over time: blue line for steering angle in degrees, red line for speed in meters per second, and green dashed line for lateral error in meters, demonstrating how each parameter changes over forty seconds.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f23"><bold>Figure&#xa0;23</bold></xref> shows the lateral error and heading error on dry, wet, and muddy road surfaces. The errors increase as the road adhesion coefficient decreases, but the lateral error on muddy roads is still controlled around 0.1 meters (occasionally exceeding this but quickly corrected), and the heading error reaches a maximum of 2.5 degrees on muddy roads. When the road surface changes abruptly (at 40 seconds and 80 seconds), the controller completes adjustments within 0.5 seconds, and the errors quickly converge. As can be seen from <xref ref-type="fig" rid="f23"><bold>Figure&#xa0;23</bold></xref>, the horizontal error has a trend of slow increase, which may be caused by the fixed deviation of GPS positioning signal or the cumulative effect of controller integration term. In the future work, this problem will be suppressed by online sensor calibration or the introduction of integration term limiter.</p>
<fig id="f23" position="float">
<label>Figure&#xa0;23</label>
<caption>
<p>Lateral error statistical distribution.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g023.tif">
<alt-text content-type="machine-generated">Line graph showing lateral and heading error values over time across three surface conditions: dry (green), wet (blue), and muddy (tan). Heading error rises significantly from dry to muddy surfaces, crossing the heading threshold, while lateral error remains below the safety threshold throughout.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f24"><bold>Figure&#xa0;24</bold></xref> presents the lateral error distribution of each segment of the rectangular path using box plots. The errors in the straight segments (0.02-0.05 m) are significantly smaller than those in the curved segments (0.05-0.10 m). All errors are below 0.1 m, meeting the requirements for agricultural operations.</p>
<fig id="f24" position="float">
<label>Figure&#xa0;24</label>
<caption>
<p>Horizontal error box plot.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g024.tif">
<alt-text content-type="machine-generated">Box plot graphic comparing lateral errors across eight path sections, with curves and straights labeled along the x-axis and lateral error in meters on the y-axis. A red dashed line represents a safety threshold of zero point one meter. All box plots remain below the safety threshold, with curves generally having higher lateral errors than straight sections. Outliers are present in some path sections, and each box plot shows distribution spread, medians, and means.</alt-text>
</graphic></fig>
<p><xref ref-type="fig" rid="f25"><bold>Figure&#xa0;25</bold></xref> illustrates the actual obstacle-avoidance path of an autonomous harvester within a 60 m &#xd7; 40 m field. The blue dashed line represents the hybrid A* planning path, while the orange solid line denotes the actual trajectory. The system successfully navigated around six obstacles, achieving an average lateral error of&lt;0.15 m and a maximum error of&lt;0.25 m. With a 100% obstacle avoidance success rate, this demonstrates the practical feasibility of the proposed framework. This figure provides visual evidence of the autonomous driving system&#x2019;s actual obstacle avoidance capabilities as described in the paper.</p>
<fig id="f25" position="float">
<label>Figure&#xa0;25</label>
<caption>
<p>Actual obstacle avoidance path of umanned harvester.</p>
</caption>
<graphic mimetype="image" mime-subtype="tiff" xlink:href="fpls-17-1754703-g025.tif">
<alt-text content-type="machine-generated">Line graph depicting a vehicle&#x2019;s east versus north distance, showing a planned path in blue and the actual trajectory in orange with deviations for obstacle avoidance. Labeled obstacles include ridges, crop piles, and a stone. Markers indicate avoidance events, with a green triangle marking the start and a red square marking the end. Performance statistics in a blue box report less than 0.15 meter average lateral error, 100 percent avoidance success, and 86 seconds completion time. A legend clarifies symbols and obstacle types.</alt-text>
</graphic></fig>
<p>These results indicate that the autonomous driving framework proposed in the paper basically meets the design objectives in real farmland environments, especially demonstrating excellent performance in path tracking accuracy and control response speed. However, its robustness under extreme road conditions still requires further optimization.</p>
</sec>
</sec>
<sec id="s4" sec-type="conclusions">
<label>4</label>
<title>Conclusions</title>
<p>This study focuses on the autonomous driving requirements of small unmanned harvesters in complex farmland environments and validates the framework through simulations and field trials. The main conclusions are as follows:</p>
<p>1. An innovative simulation platform was developed, integrating TruckSim&#x2019;s high-precision dynamic simulation with Simulink&#x2019;s flexible algorithm development. It overcomes the challenge of lacking a dedicated model for the target combine harvester (Nongjiapan 4LZ-1.5A) by strategically selecting TruckSim models (tractor-trailer for theoretical derivation, bus for full-vehicle validation) and adjusting key parameters (mass, inertia, tire characteristics). The platform achieves equivalent simulation in core dynamic behaviors like yaw response, lateral acceleration, and path tracking. Computational efficiency reaches 0.25 seconds per step, supporting real-time algorithm verification and reducing development cycles by over 50%. Simulation results show accurate replication of complex farmland conditions (dry, wet, muddy surfaces), providing a reliable environment for algorithm validation.</p>
<p>2. Core algorithm research and integration:</p>
<p>1) High-Precision Road Surface Condition Perception: Innovatively applied the Extended Kalman Filter (EKF) algorithm to fuse multi-source sensor data including wheel speed, acceleration, and yaw rate, achieving real-time online identification of the road adhesion coefficient &#x3bc;. Simulation results show that the algorithm maintains a steady-state error of less than 5% and can rapidly converge within 0.33 seconds during sudden road surface changes, providing critical road condition information for vehicle control. In field experiments under sudden road surface change conditions, the controller dynamically adjusted strategies based on the EKF-identified &#x3bc; value, with lateral error converging to a safe range (&lt;0.1m) within 0.5 seconds.</p>
<p>2) Efficient and robust path planning: Utilized a hybrid A* algorithm for global path planning in farmland environments. This algorithm combines dual heuristic functions (h1(x), h2(x)) to significantly improve search efficiency while ensuring path quality (feasibility and smoothness). It successfully achieves effective obstacle avoidance and optimal/feasible path searching in complex environments. The framework has the potential to integrate real-time &#x3bc; information for dynamic risk assessment and path adjustment, improving search efficiency by 40% compared to traditional A* algorithms, with obstacle avoidance path length increasing by only 12%, and replanning response time under 0.1 seconds. In field tests, the system successfully executed a &#x201c;rectangular&#x201d; harvesting path, safely avoiding obstacles in complex terrains such as ridges and curves (<xref ref-type="bibr" rid="B21">Oksanen and Visala, 2009</xref>).</p>
<p>3) Stable adaptive path tracking control: Designed and implemented a lane-keeping system based on PID control. Through comprehensive parameter sensitivity analysis, the PID parameters were optimized and determined as Kp=1.2, Ki=0.05, and Kd=0.12. Simulation results demonstrate that the system effectively tracks the planned path and maintains lateral vehicle stability under various road conditions, including dry, wet, and muddy surfaces. Notably, the system achieves intelligent coordination between steering demands and speed, automatically reducing speed by 28% on low-friction curves, significantly enhancing safety. Integration of road adhesion coefficient &#x3bc; information provided by the Extended Kalman Filter (EKF) lays the foundation for future implementation of adaptive control strategies, such as gain scheduling (<xref ref-type="bibr" rid="B29">Zhu and Zong, 2009</xref>).</p>
<p>3. Simulation verification and performance evaluation: The algorithm framework was validated in TruckSim-Simulink co-simulation. Through multi-dimensional performance analysis (including path tracking error, system response coordination, and 3D spatiotemporal visualization), system performance under typical farmland conditions was quantitatively assessed:</p>
<list list-type="order">
<list-item>
<p>On dry roads, the lateral tracking error remained stably within 0.05 meters, with heading error less than 1&#xb0;.</p></list-item>
<list-item>
<p>Under low-adhesion conditions such as muddy roads, the system was still able to keep the lateral error within 0.1 meters (meeting typical agricultural operation requirements), with heading error peaks &#x2264; 2.5&#xb0;.</p></list-item>
<list-item>
<p>The steering-speed coordination mechanism effectively suppressed the risk of side slip on low-friction (low-&#x3bc;) surfaces.</p></list-item>
<list-item>
<p>The simulation platform&#x2019;s computational efficiency met real-time requirements.</p></list-item>
</list>
<p>However, this study has limitations and suggests future work:</p>
<p>Limitations include using a wheeled model for tracked vehicles, neglecting steering resistance, ground pressure, and slip. It assumes gentle slopes and lacks testing in extreme terrains like steep hills. The control algorithm also overlooks suspension dynamics and vehicle pitch/roll effects on stability.</p>
<p>Future work will develop precise tracked vehicle models, integrating model predictive control techniques to enhance path tracking and adaptive capabilities. Concurrently, a multi-agent simulation system will be established to enable task allocation and collaborative obstacle avoidance among multiple unmanned harvesters. Ultimately, through long-term validation in complex all-terrain environments&#x2014;including steep slopes, deep gullies, and severely uneven surfaces&#x2014;the system will progress towards the engineering implementation phase.</p>
<sec id="s4_1">
<label>4.1</label>
<title>Limitations analysis</title>
<p>This study retains certain limitations that warrant further refinement in future work:</p>
<p>Insufficient consideration of crop dynamics: The simulations and experiments primarily focused on harvested or bare plots, failing to systematically account for the additional resistance imposed by standing crops on vehicle movement and its impact on dynamic characteristics and control stability. In practical operations, variations in crop density, height, and stalk strength may induce additional longitudinal/lateral load changes, thereby compromising path-following accuracy.</p>
<p>Limited applicability of model equivalence under extreme conditions: Although parameter adjustments achieved core dynamic equivalence between the wheeled model and tracked harvesters, the non-linear characteristics unique to tracks&#x2014;such as slippage and sinking&#x2014;may exhibit significant deviations in deep mud or high-resistance crop areas. The predictive capability of the existing model under such extreme conditions requires further validation.</p>
<p>Environmental perception and dynamic planning capabilities require enhancement: The current system primarily addresses static obstacles and fixed paths, lacking integrated real-time detection and avoidance of dynamic obstacles. It also fails to account for the dynamic impact of crop growth conditions on navigable areas.</p>
</sec>
<sec id="s4_2">
<label>4.2</label>
<title>Future work outlook</title>
<p>Based on the findings of this study and the aforementioned limitations, subsequent research may proceed along the following lines:</p>
<p>Establish a crop-vehicle coupled dynamics model by incorporating a crop resistance module into simulations, thereby more accurately reflecting vehicle-environment interactions during harvesting operations.</p>
<p>Develop control strategies adaptable to crop conditions, either by enhancing PID controllers with real-time resistance estimation or introducing model predictive control (MPC), to improve tracking robustness during harvesting tasks.</p>
<p>Enhance dynamic environmental perception and planning capabilities by integrating multi-sensor information to achieve dynamic obstacle recognition and real-time passable area updates, subsequently investigating real-time replanning algorithms.</p>
<p>Conduct long-term field validation across multiple crops and operating conditions through large-scale field trials under diverse crop types and cultivation patterns, further verifying the system&#x2019;s reliability and practicality within complex real-world agricultural environments.</p>
</sec>
</sec>
</body>
<back>
<sec id="s5" sec-type="data-availability">
<title>Data availability statement</title>
<p>The raw data supporting the conclusions of this article will be made available by the authors, without undue reservation.</p></sec>
<sec id="s6" sec-type="author-contributions">
<title>Author contributions</title>
<p>LS: Conceptualization, Funding acquisition, Methodology, Writing &#x2013; review &amp; editing. QW: Conceptualization, Software, Writing &#x2013; original draft. ZK: Investigation, Writing &#x2013; review &amp; editing. WF: Supervision, Writing &#x2013; review &amp; editing. TX: Investigation, Methodology, Writing &#x2013; review &amp; editing. GY: Funding acquisition, Investigation, Writing &#x2013; review &amp; editing.</p></sec>
<sec id="s8" sec-type="COI-statement">
<title>Conflict of interest</title>
<p>The author(s) declared that this work was conducted in the absence of any commercial or financial relationships that could be construed as a potential conflict of interest.</p></sec>
<sec id="s9" sec-type="ai-statement">
<title>Generative AI statement</title>
<p>The author(s) declared that generative AI was not used in the creation of this manuscript.</p>
<p>Any alternative text (alt text) provided alongside figures in this article has been generated by Frontiers with the support of artificial intelligence and reasonable efforts have been made to ensure accuracy, including review by the authors wherever possible. If you identify any issues, please contact us.</p></sec>
<sec id="s10" sec-type="disclaimer">
<title>Publisher&#x2019;s note</title>
<p>All claims expressed in this article are solely those of the authors and do not necessarily represent those of their affiliated organizations, or those of the publisher, the editors and the reviewers. Any product that may be evaluated in this article, or claim that may be made by its manufacturer, is not guaranteed or endorsed by the publisher.</p></sec>
<sec id="s11" sec-type="disclaimer">
<title>Author disclaimer</title>
<p>Any opinions, findings, conclusions, or recommendations expressed in this work are those of authors and do not necessarily reflect the views of Zhejiang Sci-Tech University.</p></sec>
<ref-list>
<title>References</title>
<ref id="B1">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Bai</surname> <given-names>Y.</given-names></name>
<name><surname>Zhang</surname> <given-names>B.</given-names></name>
<name><surname>Xu</surname> <given-names>N.</given-names></name>
<name><surname>Zhou</surname> <given-names>J.</given-names></name>
<name><surname>Shi</surname> <given-names>J.</given-names></name>
</person-group> (<year>2023</year>). 
<article-title>Vision-based navigation and guidance for agricultural autonomous vehicles and robots: A review</article-title>. <source>Comput. Electron. Agric.</source> <volume>205</volume>, <elocation-id>107584</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.compag.2022.107584</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B2">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Ban</surname> <given-names>C.</given-names></name>
<name><surname>Wang</surname> <given-names>L.</given-names></name>
<name><surname>Chi</surname> <given-names>R.</given-names></name>
<name><surname>Su</surname> <given-names>T.</given-names></name>
<name><surname>Ma</surname> <given-names>Y.</given-names></name>
</person-group> (<year>2024</year>). 
<article-title>A Camera-LiDAR-IMU fusion method for real-time extraction of navigation line between maize field rows</article-title>. <source>Comput. Electron. Agric.</source> <volume>223</volume>, <elocation-id>109114</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.compag.2024.109114</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B3">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Bavdekar</surname> <given-names>V. A.</given-names></name>
<name><surname>Deshpande</surname> <given-names>A. P.</given-names></name>
<name><surname>Patwardhan</surname> <given-names>S. C.</given-names></name>
</person-group> (<year>2011</year>). 
<article-title>Identification of process and measurement noise covariance for state and parameter estimation using extended Kalman filter</article-title>. <source>J. Process Control</source> <volume>21</volume>, <fpage>585</fpage>&#x2013;<lpage>601</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.jprocont.2011.01.001</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B4">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Chen</surname> <given-names>H.</given-names></name>
<name><surname>Tan</surname> <given-names>Y.</given-names></name>
<name><surname>Xiao</surname> <given-names>W.</given-names></name>
<name><surname>Li</surname> <given-names>G.</given-names></name>
<name><surname>Meng</surname> <given-names>F.</given-names></name>
<name><surname>He</surname> <given-names>T.</given-names></name>
<etal/>
</person-group>. (<year>2022</year>). 
<article-title>Urbanization in China drives farmland uphill under the constraint of the requisition-compensation balance</article-title>. <source>Sci. Total Environ.</source> <volume>831</volume>, <elocation-id>154895</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.scitotenv.2022.154895</pub-id>, PMID: <pub-id pub-id-type="pmid">35364167</pub-id>
</mixed-citation>
</ref>
<ref id="B5">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Chua</surname> <given-names>J. J. C.</given-names></name>
<name><surname>Fuss</surname> <given-names>F. K.</given-names></name>
<name><surname>Subic</surname> <given-names>A.</given-names></name>
</person-group> (<year>2011</year>). 
<article-title>Evaluation of different gyroscope sensors for smart wheelchair applications</article-title>. <source>Proc. Eng.</source> <volume>13</volume>, <fpage>519</fpage>&#x2013;<lpage>524</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.proeng.2011.05.124</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B6">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Ding</surname> <given-names>H. L.</given-names></name>
<name><surname>Zhang</surname> <given-names>C.</given-names></name>
<name><surname>Gao</surname> <given-names>Y. W.</given-names></name>
<name><surname>Huang</surname> <given-names>J. P.</given-names></name>
</person-group> (<year>2022</year>). 
<article-title>Extended Kalman filter algorithm for non-roughness and moving damage identification</article-title>. <source>Sci. Rep.</source> <volume>12</volume>, <fpage>21958</fpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1038/s41598-022-26339-z</pub-id>, PMID: <pub-id pub-id-type="pmid">36536074</pub-id>
</mixed-citation>
</ref>
<ref id="B7">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Dolgov</surname> <given-names>D.</given-names></name>
<name><surname>Thrun</surname> <given-names>S.</given-names></name>
<name><surname>Montemerlo</surname> <given-names>M.</given-names></name>
<name><surname>Diebel</surname> <given-names>J.</given-names></name>
</person-group> (<year>2010</year>). 
<article-title>Path planning for autonomous vehicles in unknown semi-structured environments</article-title>. <source>Int. J. Robotics Res.</source> <volume>29</volume>, <fpage>485</fpage>&#x2013;<lpage>501</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1177/0278364909359210</pub-id>, PMID: <pub-id pub-id-type="pmid">41732152</pub-id>
</mixed-citation>
</ref>
<ref id="B8">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Fan</surname> <given-names>P.</given-names></name>
<name><surname>Li</surname> <given-names>W.</given-names></name>
<name><surname>Cui</surname> <given-names>X.</given-names></name>
<name><surname>Lu</surname> <given-names>M.</given-names></name>
</person-group> (<year>2019</year>). 
<article-title>Precise and robust RTK-GNSS positioning in urban environments with dual-antenna configuration</article-title>. <source>Sensors</source> <volume>19</volume>, <elocation-id>3586</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.3390/s19163586</pub-id>, PMID: <pub-id pub-id-type="pmid">31426540</pub-id>
</mixed-citation>
</ref>
<ref id="B9">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Fujinaga</surname> <given-names>T.</given-names></name>
</person-group> (<year>2025</year>). 
<article-title>Autonomous navigation method for agricultural robots in high-bed cultivation environments</article-title>. <source>Comput. Electron. Agric.</source> <volume>231</volume>, <elocation-id>110001</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.compag.2025.110001</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B10">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Hart</surname> <given-names>P.</given-names></name>
<name><surname>Nilsson</surname> <given-names>N.</given-names></name>
<name><surname>Raphael</surname> <given-names>B.</given-names></name>
</person-group> (<year>1968</year>). 
<article-title>A formal basis for the heuristic determination of minimum cost paths</article-title>. <source>IEEE Trans. Syst. Sci. Cybernetics</source> <volume>4</volume>, <fpage>100</fpage>&#x2013;<lpage>107</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1109/TSSC.1968.300136</pub-id>, PMID: <pub-id pub-id-type="pmid">41116384</pub-id>
</mixed-citation>
</ref>
<ref id="B11">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Indolia</surname> <given-names>S.</given-names></name>
<name><surname>Kumar Goswami</surname> <given-names>A.</given-names></name>
<name><surname>Mishra</surname> <given-names>S. P.</given-names></name>
<name><surname>Asopa</surname> <given-names>P.</given-names></name>
</person-group> (<year>2018</year>). 
<article-title>Conceptual understanding of convolutional neural network- A deep learning approach</article-title>. <source>Proc. Comput. Sci.</source> <volume>132</volume>, <fpage>679</fpage>&#x2013;<lpage>688</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.procs.2018.05.069</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B12">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Jin</surname> <given-names>X.</given-names></name>
<name><surname>Liu</surname> <given-names>J.</given-names></name>
<name><surname>Chen</surname> <given-names>Z.</given-names></name>
<name><surname>liu</surname> <given-names>M.</given-names></name>
<name><surname>li</surname> <given-names>M.</given-names></name>
<name><surname>Xu</surname> <given-names>Z.</given-names></name>
<etal/>
</person-group>. (<year>2024</year>). 
<article-title>Precision control system of rice potting and transplanting machine based on GA-Fuzzy PID controller</article-title>. <source>Comput. Electron. Agric.</source> <volume>220</volume>, <elocation-id>108912</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.compag.2024.108912</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B13">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Jin</surname> <given-names>Y.</given-names></name>
<name><surname>Li</surname> <given-names>Y.</given-names></name>
<name><surname>He</surname> <given-names>B.</given-names></name>
<name><surname>Yang</surname> <given-names>X.</given-names></name>
<name><surname>Zheng</surname> <given-names>L.</given-names></name>
</person-group> (<year>2024</year>). 
<article-title>Mass estimation of tractor-semitrailer systems: An approach of dynamics and data fusion-driven in real environments</article-title>. <source>Measurement</source> <volume>238</volume>, <elocation-id>115367</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.measurement.2024.115367</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B14">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Kang</surname> <given-names>H.</given-names></name>
<name><surname>Wang</surname> <given-names>X.</given-names></name>
<name><surname>Chen</surname> <given-names>C.</given-names></name>
</person-group> (<year>2022</year>). 
<article-title>Accurate fruit localisation using high resolution LiDAR-camera fusion and instance segmentation</article-title>. <source>Comput. Electron. Agric.</source> <volume>203</volume>, <elocation-id>107450</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.compag.2022.107450</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B15">
<mixed-citation publication-type="confproc">
<person-group person-group-type="author">
<name><surname>Kebbati</surname> <given-names>Y.</given-names></name>
<name><surname>Ait-Oufroukh</surname> <given-names>N.</given-names></name>
<name><surname>Vigneron</surname> <given-names>V.</given-names></name>
<name><surname>Ichalal</surname> <given-names>D.</given-names></name>
<name><surname>Gruyer</surname> <given-names>D.</given-names></name>
</person-group> (<year>2021</year>). &#x201c;
<article-title>Optimized self-adaptive PID speed control for autonomous vehicles</article-title>,&#x201d; in <conf-name>2021 26th International Conference on Automation and Computing (ICAC)</conf-name>. (<publisher-loc>Portsmouth (UK)</publisher-loc>: 
<publisher-name>IEEE</publisher-name>) <fpage>1</fpage>&#x2013;<lpage>6</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.23919/ICAC50006.2021.9594131</pub-id>
</mixed-citation>
</ref>
<ref id="B16">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Li</surname> <given-names>Z.</given-names></name>
<name><surname>Shi</surname> <given-names>N.</given-names></name>
<name><surname>Zhao</surname> <given-names>L.</given-names></name>
<name><surname>Zhang</surname> <given-names>M.</given-names></name>
</person-group> (<year>2024</year>). 
<article-title>Deep reinforcement learning path planning and task allocation for multi-robot collaboration</article-title>. <source>Alexandria Eng. J.</source> <volume>109</volume>, <fpage>408</fpage>&#x2013;<lpage>423</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.aej.2024.08.102</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B17">
<mixed-citation publication-type="book">
<person-group person-group-type="author"><collab>Mechanical Simulation Corporation</collab>
</person-group> (<year>2021</year>). <source>TruckSim user manual version 2021.1</source> (<publisher-loc>MI, USA</publisher-loc>: 
<publisher-name>Ann Arbor</publisher-name>). Available online at: <uri xlink:href="https://www.carsim.com/products/trucksim/">https://www.carsim.com/products/trucksim/</uri> (Accessed <date-in-citation content-type="access-date">August 11, 2025</date-in-citation>).
</mixed-citation>
</ref>
<ref id="B18">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Becker</surname> <given-names>J.</given-names></name>
<name><surname>Bhat</surname> <given-names>S.</given-names></name>
<name><surname>Dahlkamp</surname> <given-names>H.</given-names></name>
<name><surname>Dolgov</surname> <given-names>D.</given-names></name>
<name><surname>Ettinger</surname> <given-names>S.</given-names></name>
<etal/>
</person-group>. (<year>2008</year>). 
<article-title>Junior: The Stanford entry in the urban challenge</article-title>. <source>J. Field Robotics</source> <volume>25</volume>, <fpage>569</fpage>&#x2013;<lpage>597</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1002/rob.20258</pub-id>, PMID: <pub-id pub-id-type="pmid">41744314</pub-id>
</mixed-citation>
</ref>
<ref id="B19">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Nehme</surname> <given-names>H.</given-names></name>
<name><surname>Aubry</surname> <given-names>C.</given-names></name>
<name><surname>Solatges</surname> <given-names>T.</given-names></name>
<name><surname>Savatier</surname> <given-names>X.</given-names></name>
<name><surname>Rossi</surname> <given-names>R.</given-names></name>
<name><surname>Boutteau</surname> <given-names>R.</given-names></name>
</person-group> (<year>2021</year>). 
<article-title>LiDAR-based structure tracking for agricultural robots: application to autonomous navigation in vineyard</article-title>. <source>J. Intell. Robot Syst.</source> <volume>103</volume>, <fpage>61</fpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1007/s10846-021-01519-7</pub-id>, PMID: <pub-id pub-id-type="pmid">41746348</pub-id>
</mixed-citation>
</ref>
<ref id="B20">
<mixed-citation publication-type="book">
<person-group person-group-type="author">
<name><surname>Ogata</surname> <given-names>K.</given-names></name>
</person-group> (<year>2010</year>). <source>Modern control engineering</source>. <edition>5th ed</edition> (<publisher-loc>Upper Saddle River, NJ</publisher-loc>: 
<publisher-name>Pearson</publisher-name>).
</mixed-citation>
</ref>
<ref id="B21">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Oksanen</surname> <given-names>T.</given-names></name>
<name><surname>Visala</surname> <given-names>A.</given-names></name>
</person-group> (<year>2009</year>). 
<article-title>Coverage path planning algorithms for agricultural field machines</article-title>. <source>J. Field Robotics</source> <volume>26</volume>, <fpage>651</fpage>&#x2013;<lpage>668</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1002/rob.20300</pub-id>, PMID: <pub-id pub-id-type="pmid">41744314</pub-id>
</mixed-citation>
</ref>
<ref id="B22">
<mixed-citation publication-type="book">
<person-group person-group-type="author">
<name><surname>Pacejka</surname> <given-names>H.</given-names></name>
</person-group> (<year>2012</year>). <source>Tire and vehicle dynamics</source>. <edition>3rd ed</edition> (<publisher-loc>Warrendale, PA</publisher-loc>: 
<publisher-name>SAE International</publisher-name>).
</mixed-citation>
</ref>
<ref id="B23">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Peicheng</surname> <given-names>S.</given-names></name>
<name><surname>Li</surname> <given-names>L.</given-names></name>
<name><surname>Ni</surname> <given-names>X.</given-names></name>
<name><surname>Yang</surname> <given-names>A.</given-names></name>
</person-group> (<year>2022</year>). 
<article-title>Intelligent vehicle path tracking control based on improved MPC and hybrid PID</article-title>. <source>IEEE Access</source> <volume>10</volume>, <fpage>94133</fpage>&#x2013;<lpage>94144</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1109/ACCESS.2022.3203451</pub-id>, PMID: <pub-id pub-id-type="pmid">41116384</pub-id>
</mixed-citation>
</ref>
<ref id="B24">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Rachmawati</surname> <given-names>D.</given-names></name>
<name><surname>Gustin</surname> <given-names>L.</given-names></name>
</person-group> (<year>2020</year>). 
<article-title>Analysis of dijkstra&#x2019;s algorithm and A* Algorithm in shortest path problem</article-title>. <source>J. Phys: Conf. Ser.</source> <volume>1566</volume>, <fpage>012061</fpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1088/1742-6596/1566/1/012061</pub-id>
</mixed-citation>
</ref>
<ref id="B25">
<mixed-citation publication-type="book">
<person-group person-group-type="author">
<name><surname>Rajamani</surname> <given-names>R.</given-names></name>
</person-group> (<year>2012</year>). <source>Vehicle dynamics and control</source>. <edition>2nd ed</edition> (<publisher-loc>New York, NY</publisher-loc>: 
<publisher-name>Springer</publisher-name>). doi:&#xa0;<pub-id pub-id-type="doi">10.1007/978-1-4614-1433-9</pub-id>, PMID: <pub-id pub-id-type="pmid">41746348</pub-id>
</mixed-citation>
</ref>
<ref id="B26">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Sert</surname> <given-names>E.</given-names></name>
<name><surname>Boyraz</surname> <given-names>P.</given-names></name>
</person-group> (<year>2017</year>). 
<article-title>Optimization of suspension system and sensitivity analysis for improvement of stability in a midsize heavy vehicle</article-title>. <source>Eng. Sci. Technology an Int. J.</source> <volume>20</volume>, <fpage>997</fpage>&#x2013;<lpage>1012</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1016/j.jestch.2017.03.007</pub-id>, PMID: <pub-id pub-id-type="pmid">41743167</pub-id>
</mixed-citation>
</ref>
<ref id="B27">
<mixed-citation publication-type="book">
<person-group person-group-type="author">
<name><surname>Svendenius</surname> <given-names>J.</given-names></name>
</person-group> (<year>2007</year>). <source>Tire Modelling and Friction Estimation.</source> [Doctoral thesis]. (<publisher-loc>Lund</publisher-loc>: 
<publisher-name>Lund University</publisher-name>).
</mixed-citation>
</ref>
<ref id="B28">
<mixed-citation publication-type="journal">
<person-group person-group-type="author">
<name><surname>Zhang</surname> <given-names>S.</given-names></name>
<name><surname>Liu</surname> <given-names>Q.</given-names></name>
<name><surname>Xu</surname> <given-names>H.</given-names></name>
<name><surname>Yang</surname> <given-names>Z.</given-names></name>
<name><surname>Hu</surname> <given-names>X.</given-names></name>
<name><surname>Song</surname> <given-names>Q.</given-names></name>
<etal/>
</person-group>. (<year>2025</year>). 
<article-title>Path tracking control of a large rear-wheel&#x2013;steered combine harvester using feedforward PID and look-ahead ackermann algorithms</article-title>. <source>Agriculture</source> <volume>15</volume>, <elocation-id>676</elocation-id>. doi:&#xa0;<pub-id pub-id-type="doi">10.3390/agriculture15070676</pub-id>, PMID: <pub-id pub-id-type="pmid">41725453</pub-id>
</mixed-citation>
</ref>
<ref id="B29">
<mixed-citation publication-type="book">
<person-group person-group-type="author">
<name><surname>Zhu</surname> <given-names>T.</given-names></name>
<name><surname>Zong</surname> <given-names>C.</given-names></name>
</person-group> (<year>2009</year>). &#x201c;
<article-title>The road friction coefficient estimation based on extended kalman filter</article-title>,&#x201d; in <source>2009 international workshop on intelligent systems and applications</source>. (<publisher-loc>Wuhan, China</publisher-loc>: 
<publisher-name>IEEE</publisher-name>) <fpage>1</fpage>&#x2013;<lpage>4</lpage>. doi:&#xa0;<pub-id pub-id-type="doi">10.1109/IWISA.2009.5073206</pub-id>, PMID: <pub-id pub-id-type="pmid">41116384</pub-id>
</mixed-citation>
</ref>
</ref-list>
<fn-group>
<fn id="n1" fn-type="custom" custom-type="edited-by">
<p>Edited by: <ext-link ext-link-type="uri" xlink:href="https://loop.frontiersin.org/people/1107972">Ning Yang</ext-link>, Jiangsu University, China</p></fn>
<fn id="n2" fn-type="custom" custom-type="reviewed-by">
<p>Reviewed by: <ext-link ext-link-type="uri" xlink:href="https://loop.frontiersin.org/people/2733615">Li Ma</ext-link>, Northeast Agricultural University, China</p>
<p><ext-link ext-link-type="uri" xlink:href="https://loop.frontiersin.org/people/3184664">Tao Li</ext-link>, Jiangxi Agricultural University, China</p>
<p><ext-link ext-link-type="uri" xlink:href="https://loop.frontiersin.org/people/3301433">Kan Zheng</ext-link>, Huazhong Agricultural University, China</p></fn>
</fn-group>
</back>
</article>