In this paper. an algorithm is proposed to solve the non-convex optimization problem using sequential convex programming. An approximation method was used to solve the collision avoidance constraint. An iterative approach was utilized to estimate the non-convex constraints. https://cuttingedgecutleryco.shop/product-category/keychain/