源:机器人局部避障的动态窗口法(dynamic window approach) 首先在V_m∩V_d的范围内采样速度: allowable_v = generateWindow(robotV, robotModel) allowable_w = generateWindow(robotW, robotModel) 然后根据能否及时刹车剔除不安全的速度: for each v in allowable_v for each w in allowable_w dist = find_dist(v,…