Collision-Free Trajectory Optimization in Cluttered Environments Using Sums-of-Squares Programming

Yulin Li, Chunxin Zheng, Kai Chen +4

In this work, we propose a trajectory optimization approach for robot navigation in cluttered 3D environments. We represent the robot's geometry as a semialgebraic set defined by p…