This letter proposes an algorithm for full-velocity estimation by fusing radial velocity vectors obtained from 4D radar with optical flow vectors extracted from camera images. The full-velocity algorithm consists of a preprocessing step and a full-velocity vector estimation step. In preprocessing, radar noise is removed and ego-vehicle velocity estimation is enhanced using a Hampel filter for improved robustness in dynamic environments. In the full-velocity estimation stage, the algorithm estimates full-velocity vectors using a formulation derived from mathematical equations that incorporate multiple constraints. To evaluate the proposed method, an embedded system is implemented on a real vehicle, and datasets are collected under various scenarios. Experimental results show that the proposed algorithm significantly improves object velocity estimation performance. (error rate: baseline 81% $\rightarrow$ proposed 31%).
28 May 2026 in International Journal of Control, Automation, and Systems
This paper proposes an autonomous navigation framework for orchard weeding robots based on the ZTR (Zero Turn Radius) platform. Unlike conventional agricultural robots, our system utilizes multiple sensors, including GNSS, IMU, 2D LiDAR, and cameras, to achieve reliable object detection and accurate position estimation based on the Extended Kalman Filter (EKF). For path tracking, we implemented a pure-pursuit algorithm with a look-ahead distance strategy, which is particularly effective for ensuring stable navigation at low speeds. To evaluate the path tracking performance, experiments were conducted in a structured orchard environment. During autonomous navigation for an average of 8.54 min, the proposed framework achieved an average trajectory error of 11.66 cm. For localization performance evaluation, the proposed algorithm was compared with a baseline method that fuses raw GPS and IMU data. The proposed method achieved a mean error of 0.0078 m, representing a 78.3% improvement in accuracy over the baseline.
Considering the nonlinear dynamics, this paper devises an advanced position trajectory tracking controller with a model-free filter for two-wheeled vehicle (TWV) applications. The proposed technique preserves a simple structure in the form of the proportional–integral (PI) controller involving the model-free filter and nonlinearly structured feedback gains, which make the following contributions: (a) the proposed filter smooths the position and yaw angle measurements according to the first-order convergence rate without any model information; and (b) the PI control with the nonlinearly structured feedback gains robustly stabilizes the position and yaw angle errors along the desired first-order system to accomplish the trajectory tracking mission, which is obtained by the pole-zero cancellation (PZC) in the presence of modeling errors. MATLAB/Simulink was used to emulate the resulting feedback system and validate the effectiveness of the proposed technique.