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])
