Python实现改进后的Bi-RRT算法实例( 二 ) _生活百科

< cos_value < 1.0 + eps:cos_value = 1.0elif -1.0 - eps < cos_value < -1.0:cos_value = -1.0arc_value = np.arccos(cos_value)angle_value = arc_value * (180 / np.pi)return angle_valuedef get_total_distance(path):"""计算路径总长度:param path::return:"""total_distance = 0for index in range(2, len(path)-1):one = path[index-1]two = path[index]total_distance += np.sqrt(np.square(two[0] - one[0]) + np.square(two[1] - one[0]))print(total_distance)def main():print("============================Start planning your path============================")rand_area = [0, 100]# 区域大小step = 10# 基础步长angle = 60# 最大转向角distance = 5# 最小航行距离start = [0, 0]# 起点goal = [100, 100]# 终点safe = [20, 20]recover = [90, 90]# 障碍物obstacle_list = [(50, 50, 15),(62, 13, 12),(50, 87, 11)]bi_rrt = BiRRT(start=start, goal=goal, angle=angle, step=step, distance=distance, obstacle_list=obstacle_list,rand_area=rand_area, safe=safe, recover=recover)path, path_1, path_2 = bi_rrt.planning()bi_rrt.draw_statistic(path)get_total_distance(path)print("==========================End of planned path==========================")if __name__ == '__main__':main()4. 效果图

文章插图

Python实现改进后的Bi-RRT算法实例( 二 )

推荐阅读

好听的双胞胎男孩名字

十二星座专属配套服装

机动车检验去哪里办理

快手小店上传商品审核多久快手商品审核多长时间

绝地求生怎么跑绝地求生快速跑动按键详解

西梅可以冷冻保存吗怎么吃西梅可以冷冻保存吗

冰箱里放三天的饭菜还可以吃吗饭菜放冰箱三天能吃吗

白城到长春白城到长春客车时间表

立秋后的第一杯奶茶是什么意思?

依维柯宝迪edc灯消不掉怎么回事依维柯宝迪提示灯

护士节的来历

2020年07月14日双子座事业爱情运势

三国程普怎么死的

请评教是什么意思网上评教是什么意思

狮子座生日狮子座是几月份

怎么自制减肥营养餐

人生自古谁无死出自哪首诗人生自古谁无死

关于感恩节的作文600字

汽车用品买什么是必备的买车以后有哪些重要的车用品

炒猪肚用什么配菜好吃炒猪肚用什么配菜