Telos4
/
RoboRally
1
0
Fork 1
Code Issues Pull Requests Releases Wiki Activity

added condition if marker cannot be found

simple_control
Simon Pirkelmann 2019-06-27 14:11:19 +02:00
parent b54c2d565c
commit 2a5e0e8ae7
1 changed files with 3 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
remote_control/casadi_opt.py
View File

@ -236,8 +236,9 @@ class OpenLoopSolver:
for o in obstacles:
p = obstacles[o].pos
r = obstacles[o].radius
for k in range(1,self.N):
self.opti.subject_to((self.X[0,k]-p[0])**2 + (self.X[1,k]-p[1])**2 + self.slack > r**2)
if p is not None:
for k in range(1,self.N):
self.opti.subject_to((self.X[0,k]-p[0])**2 + (self.X[1,k]-p[1])**2 + self.slack > r**2)
# pass
posx = self.X[0, :]
posy = self.X[1, :]