Robotics Engineer - ALOG Tech

Global Path Planning for Robot with N-Trailers

Learn more about ALOG Tech here

Problem Statement

The objective of my project was to find a path for the robot that considers the trajectories of the trailers and avoids collisions.

Path planning for just the robot

Path planning including trailer trajectories.


Approaches Tested

I tested multiple approaches to solve the problem:

  • Turning Radius
  • Geometric approach for velocity and steering angles with obstacle avoidance
  • Hybrid A* for truck trailer system
  • Deterministic grid-based search

Introduction

I explored both general and standard trailers to understand their kinematics and control processes.

Standard Trailer System

General Trailer System.


Approach 1: Geometric Approach

This approach involves targeting convergence and obstacle avoidance for a non-standard tractor-trailer robot using a geometric method.

  • Kinematic model of the system
  • Design of control inputs

The control inputs are designed based on numerical integration of nonlinear differential equations using a 4th order Runge Kutta method. Obstacles are defined as either lines or ellipses. To ensure safety, I enclosed the tractor and each trailer in the smallest possible circles and adjusted the control inputs accordingly.


Approach 2: Hybrid A* for Truck Trailer System

This approach uses a Hybrid A* algorithm to find a path while checking for trailers. It evaluates all possible configurations and removes those that result in collisions.

The Hybrid A* algorithm was chosen for its ability to include trailers in the path planning process, unlike the general A* algorithm. However, this increases computational complexity with the number of trailers.


Approach 3: Deterministic Grid-Based Search

This approach uses a deterministic grid-based search with a cost function calculated based on the error between the truck and trailer wheels.

A potentiometer measures the angle between the truck and the trailer to determine the error for the controller.


Approach 4: Turning Radius

I calculated the maximum possible turning radius for the system, considering the maximum offset that can safely maneuver turns for N trailers. However, this approach proved less effective as it didn't account for realistic offsets.

Subproblem Division

Approach 5: Nonlinear Programming based

This approach is based off of recent research in the field : ICRA Paper. While this approach works , it is not online and requires very high computation time and resources as the number of trailers increase.


Simulation Approaches

I simulated the system in ROS and Gazebo using two approaches:

  • Approach 1: Defining the robot and trolleys in a xacro/urdf file and simulating in a known environment. However, the hinge joint behavior was unexpected, and the Rviz representation was inaccurate.
  • Approach 2: Launching the robot in Gazebo and adding trailers as models. This approach provided accurate representations but faced initial setup issues.

Conclusion

This project allowed me to explore various path planning algorithms for a robot with N-trailers. Each approach had its strengths and weaknesses, providing valuable insights for future work. I plan to refine these approaches and address the identified issues to develop a robust solution for global path planning with multiple trailers.