Optimal Trajectory Planning for Wheeled Mobile Robots under Localization Uncertainty and Energy Efficiency Constraints

Xiaolong Zhang,Yu Huang,Youmin Rong,Gen Li,Hui Wang,Chao Liu

DOI: https://doi.org/10.3390/s21020335

IF: 3.9

2021-01-06

Sensors

Abstract:With the rapid development of robotics, wheeled mobile robots are widely used in smart factories to perform navigation tasks. In this paper, an optimal trajectory planning method based on an improved dolphin swarm algorithm is proposed to balance localization uncertainty and energy efficiency, such that a minimum total cost trajectory is obtained for wheeled mobile robots. Since environmental information has different effects on the robot localization process at different positions, a novel localizability measure method based on the likelihood function is presented to explicitly quantify the localization ability of the robot over a prior map. To generate the robot trajectory, we incorporate localizability and energy efficiency criteria into the parameterized trajectory as the cost function. In terms of trajectory optimization issues, an improved dolphin swarm algorithm is then proposed to generate better localization performance and more energy efficiency trajectories. It utilizes the proposed adaptive step strategy and learning strategy to minimize the cost function during the robot motions. Simulations are carried out in various autonomous navigation scenarios to validate the efficiency of the proposed trajectory planning method. Experiments are performed on the prototype “Forbot” four-wheel independently driven-steered mobile robot; the results demonstrate that the proposed method effectively improves energy efficiency while reducing localization errors along the generated trajectory.

engineering, electrical & electronic,chemistry, analytical,instruments & instrumentation

What problem does this paper attempt to address?

The problem that this paper attempts to solve is how to find the optimal trajectory in the path planning of wheeled mobile robots under the constraints of localization uncertainty and energy efficiency. Specifically:

1. **Localization Uncertainty**: During the autonomous navigation of robots, reliable localization is a basic requirement. Large localization errors or localization failures will lead to excessive tracking errors of the robot and even cause safety problems. Especially in ambiguous environments such as long corridors and open areas, existing localization methods may not be applicable, resulting in localization uncertainty.

2. **Energy Efficiency**: For wheeled mobile robots, optimizing energy consumption is crucial because the battery capacity is limited. In order to extend the running time of the robot, it is necessary to optimize its energy consumption, especially when it runs automatically for a long time.

The paper proposes an optimal trajectory planning method based on the improved Dolphin Swarm Algorithm (DSA) to balance localization uncertainty and energy efficiency, so that the wheeled mobile robot can not only ensure the minimization of the total cost but also effectively improve energy efficiency and reduce the localization error along the trajectory when moving from the starting position to the target position.

### Main Contributions

1. **Proposed a New Localizability Measurement Method**: Explicitly quantify the impact of environmental information on the localization of mobile robots based on the likelihood function.
2. **Constructed a Localizability - Aware Map (LAM)**: By using the above - mentioned localizability measurement method, the localization error at a given position can be effectively estimated.
3. **Proposed an Optimal Trajectory Planning Method under the Constraints of Localization Uncertainty and Energy Efficiency**: By introducing the improved Dolphin Swarm Algorithm (DSA) into the trajectory optimization process, use the adaptive step - size strategy and learning strategy to minimize the cost function during the movement process.
4. **Experimental Verification**: Comprehensive experiments were carried out on the developed prototype "Forbot" mobile robot. The results show that the proposed trajectory planning method can effectively balance localization uncertainty and energy efficiency when the robot navigates along the trajectory and ensure the minimum total cost.

### Mathematical Formula Representation

- **Energy Consumption Model**:
\[
E_t(t)=E_k(t)+E_a(t)+E_e(t)
\]
where,
\[
E_k(t)=\int(m\max(v(t)a(t), 0)+I\max(\gamma(t)\delta(t), 0))dt
\]
\[
E_a(t)=\int\left(\sum_{i = 0}^{N}\mu mgNv_{wi}\right)dt
\]
\[
E_e(t)=P_et
\]

- **Localizability Evaluation Value (LEV)**:
\[
LEV(x)=\frac{\sum_{\Delta x_i\in\Omega}\Gamma(x+\Delta x_i)P_A(x+\Delta x_i|x)}{\sum_{\Delta x_i\in\Omega}P_A(x+\Delta x_i|x)}
\]
where,
\[
\Gamma(x+\Delta x_i)=(\Delta x_i^2+\Delta y_i^2)^{1/2}+\delta|\Delta\theta_i|
\]

- **Improved Cost Function**:
\[
g(n_i)=g(n_{i - 1})+\alpha_1C_l+\alpha_2C_e
\]
where,
\[
C_l = LEV(n_i)
\]
\[
C_e(n_i)=2\eta(n_i)\mu_{n_{i - 1},n_i}gs_{n_{i - 1},n_i}
\]

These formulas show the key calculation methods involved in the paper, ensuring that localization uncertainty and energy efficiency can be comprehensively considered when optimizing the trajectory.