ma_carmunk.py 文件源码

def check_getback(self, x_point):
        '''
            Check car have to be back.
            x_point : back point
        '''
        x, y = self.car_body.position
        if x >= x_point: return True
        else: return False

    # def testFindGoal(self):
    #     if self.color == 0:
    #         dist1 = self._euclidean_dist(self.redGoal[0])
    #         dist2 = self._euclidean_dist(self.redGoal[1])
    #         if dist1 < dist2:
    #             angle = self._get_angle(self.redGoal[0])
    #         else:
    #             angle = self._get_angle(self.redGoal[1])
    #         # angle = self._get_angle(self.redGoal[0])
    #     else:
    #         # angle = self._get_angle(self.greenGoal[0])
    #         dist1 = self._euclidean_dist(self.greenGoal[0])
    #         dist2 = self._euclidean_dist(self.greenGoal[1])
    #         if dist1 < dist2:
    #             angle = self._get_angle(self.greenGoal[0])
    #         else:
    #             angle = self._get_angle(self.greenGoal[1])
    #     return angle