] futureBackward1 = [ centerRobot1[0] - speed * math.cos(rotationRobot1), centerRobot1[1] - speed * math.sin(rotationRobot1), ] # pygame.draw.circle(gameDisplay, green,(futureBackward1), 15, 0) # print "Robot 1 Boundary, backward: ", Line_Functions.isHittingAnyBoundary(futureBackward1, distance1, 30, displaywidth, displayheight) # print "Robot 1 Collision, backward: ", Line_Functions.isIntersecting(futureBackward1, centerRobot2, distance1, distance2, 20) # print "Center 1: ", centerRobot1, " ", "Future Backward 1: ", futureBackward1, " ", "Center 2: ", centerRobot2 if not Line_Functions.isHittingAnyBoundary( futureForward1, distance1, 30, displaywidth, displayheight ) and not Line_Functions.isIntersecting(futureForward1, centerRobot2, distance1, distance2, 20): print "Move Forward 1" Movement.startBounce(0, "f", 0.5) elif not Line_Functions.isHittingAnyBoundary( futureBackward1, distance1, 30, displaywidth, displayheight ) and not Line_Functions.isIntersecting(futureBackward1, centerRobot2, distance1, distance2, 20): print "Move Backward 1" Movement.startBounce(0, "b", 0.5) else: print "Stop 1" Movement.stop(0) futureForward2 = [ centerRobot2[0] + speed * math.cos(rotationRobot2), centerRobot2[1] + speed * math.sin(rotationRobot2), ] futureBackward2 = [ centerRobot2[0] - speed * math.cos(rotationRobot2),
if(Line_Functions.isIntersecting(centerRobot1, centerRobot2, distance1, distance2, 20)): if collisionPrecedent: collision = True futureForward1 = [centerRobot1[0] + speed * math.cos(rotationRobot1), centerRobot1[1] + speed * math.sin(rotationRobot1)] futureBackward1 = [centerRobot1[0] - speed * math.cos(rotationRobot1), centerRobot1[1] - speed * math.sin(rotationRobot1)] #pygame.draw.circle(gameDisplay, green,(futureBackward1), 15, 0) #print "Robot 1 Boundary, backward: ", Line_Functions.isHittingAnyBoundary(futureBackward1, distance1, 30, displaywidth, displayheight) #print "Robot 1 Collision, backward: ", Line_Functions.isIntersecting(futureBackward1, centerRobot2, distance1, distance2, 20) #print "Center 1: ", centerRobot1, " ", "Future Backward 1: ", futureBackward1, " ", "Center 2: ", centerRobot2 if not Line_Functions.isHittingAnyBoundary(futureForward1, distance1, 30, displaywidth, displayheight) and not Line_Functions.isIntersecting(futureForward1, centerRobot2, distance1, distance2, 20): print "Move Forward 1" Movement.startBounce(0, 'f', 0.5) elif not Line_Functions.isHittingAnyBoundary(futureBackward1, distance1, 30, displaywidth, displayheight)and not Line_Functions.isIntersecting(futureBackward1, centerRobot2, distance1, distance2, 20): print "Move Backward 1" Movement.startBounce(0, 'b', 0.5) else: print "Stop 1" Movement.stop(0) futureForward2 = [centerRobot2[0] + speed * math.cos(rotationRobot2), centerRobot2[1] + speed * math.sin(rotationRobot2)] futureBackward2 = [centerRobot2[0] - speed * math.cos(rotationRobot2), centerRobot2[1] - speed * math.sin(rotationRobot2)] #pygame.draw.circle(gameDisplay, blue,(futureBackward2), 15, 0) #print "Robot 2 Boundary, backward: ", Line_Functions.isHittingAnyBoundary(futureBackward2, distance2, 30, displaywidth, displayheight) #print "Robot 2 Collision, backward: ", Line_Functions.isIntersecting(centerRobot1, futureBackward2, distance1, distance2, 20) #print "Center 2: ", centerRobot2, " ", "Future Backward 2: ", futureBackward2, " ", "Center 1: ", centerRobot1