def update_head_position(self): head_position=robotbody.get_head_position() if like(head_position,self.wanted_head_position): if like(head_position,[pi/2,0]): self.wanted_head_position=[-pi/2,pi/3.5] elif like(head_position[0],pi/2): self.wanted_head_position=[-pi/2,0] else: self.wanted_head_position[0]=head_position[0]+pi/15 robotbody.set_head_position(self.wanted_head_position[0],self.wanted_head_position[1])
def entry(self): self.head_position=robotbody.get_head_position() walk.set_velocity(0, 0.4, self.head_position[0]) robotbody.set_head_position(0, pi/3.2) print("turning towards the goal")
def update_head_position(self): angles=ball_angle() robotbody.set_head_position(angles[0],angles[1])