fix error handling

This commit is contained in:
Atsushi Sakai
2018-01-22 16:28:14 -08:00
parent dee2a6d0a4
commit d302e2756b

View File

@@ -156,6 +156,9 @@ class RRT():
# print("OK YAW TH num is")
# print(len(fgoalinds))
if len(fgoalinds) == 0:
return None
mincost = min([self.nodeList[i].cost for i in fgoalinds])
for i in fgoalinds:
if self.nodeList[i].cost == mincost: