基于人工势场法的UR5机械臂避障算法（Python）

最新推荐文章于 2024-05-19 21:31:37 发布

孟德尔的猫

最新推荐文章于 2024-05-19 21:31:37 发布

阅读量5.5k

点赞数 13

分类专栏： ROS学习笔记

本文链接：https://blog.csdn.net/qq_42823342/article/details/117429756

版权

参考文献：

祝敬,杨马英.基于改进人工势场法的机械臂避障路径规划[J].计算机测量与控制,2018,26(10):205-210.

主要代码：

          def path_planning(self) -> List[Joint_point]:
                    """
                    Start the path planning
                    """
                    #Initial theta
                    theta = self.start.theta
                    #Initial the path
                    path = [self.start]
                    while True:
                              """
                              Initial the U and theta_list
                              U : Stores the total potential energy of once search
                              joint_point_list : Stores the joint_point of once search
                              """
                              U = []