def execute_cb(self, goal):
self._goalDonei = 0
self._goal = goal
success = False
self._world = new_world(range(len(get_list('LOCATIONS'))))
print self._world.robot.locId
self.print_goal()
while not success:
soarResult = interface.main()
if soarResult == 'aborted':
self._result.outcome = 'aborted'
self._as.set_succeeded(self._result)
success = True
else:
if len(self._goal.orderList) == self._goalDonei:
# if 3 == self._goalDonei:
self._result.outcome = 'succeeded'
rospy.loginfo('%s: Succeeded' % self._action_name)
self._as.set_succeeded(self._result)
success = True
else:
self._world.update_world(self._last_goal)
self.print_goal()
"""
def execute_cb(self, goal):
self._goalDonei = 0 #contador de goals
self._goal = goal #saving our goal in self for more comfortable usage
success = False #flag to know when we have succeed
self._world = new_world(range(len(get_list('LOCATIONS')))) #generates a new world
print self._world.robot.locId
self.print_goal()
#"-----------------------------------------------------------orders list------------------------------"
rospy.logwarn (str(self._goal.orderList))
while not success:
soarResult = interface.main(self._world)
if soarResult == 'aborted':
self._result.outcome = 'aborted'
self._as.set_succeeded(self._result)
success = True
if TEST:
rospy.logerr("THE SENTENCE IS: "+str(self._goal.orderList)+"\n")
self.targfile.write(str(self._goal.orderList).replace('\n','\t').replace(',','\n')+"\n\n")
else:
if len(self._goal.orderList) == self._goalDonei:
self._result.outcome = 'succeeded'
rospy.loginfo('%s: Succeeded' % self._action_name)
self._as.set_succeeded(self._result)
success = True
else:
self._world.update_world(self._last_goal)
self.print_goal()
"""
def firstjob(worker):
global m
m = mou.mouse()
fp = open("data.txt", "w")
#fp.close()
#os.system('cls')
main2.iris_average = 1
time.sleep(1)
fp.write(
'"Ratios "\n {0} \n {1}\n iris_ratops \n {2} \n"screen coordinates"\n {3}\niris_ratios \n'
.format(main2.ratios, main2.iris, m, main2.iris_ratios))
#main2.mouselist=m
main2.callibration = False
int4.main()
def execute_cb(self, goal):
self._goalDonei = 0 #contador de goals
self._goal = goal #saving our goal in self for more comfortable usage
success = False #flag to know when we have succeed
self._world = new_world(range(len(
get_list('LOCATIONS')))) #generates a new world
print self._world.robot.locId
self.print_goal()
self._world.set_current_position('referee')
#"-----------------------------------------------------------orders list------------------------------"
rospy.logwarn(str(self._goal.orderList))
while not success:
soarResult = interface.main(self._world)
self.gpsr_category_flag_hack = 1
rospy.logwarn(self.gpsr_category_flag_hack)
rospy.logwarn(
'BBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBBB'
)
if soarResult == 'aborted':
self._result.outcome = 'aborted'
self._as.set_succeeded(self._result)
success = True
if TEST:
rospy.logerr("THE SENTENCE IS: " +
str(self._goal.orderList) + "\n")
self.targfile.write(
str(self._goal.orderList).replace('\n', '\t').replace(
',', '\n') + "\n\n")
else:
if len(self._goal.orderList) == self._goalDonei:
self._result.outcome = 'succeeded'
rospy.loginfo('%s: Succeeded' % self._action_name)
self._as.set_succeeded(self._result)
success = True
else:
self._world.update_world(self._last_goal)
self.print_goal()
self.gpsr_category_flag_hack = 0
rospy.logwarn("FINISHING SENTENCE")
call_go_to('referee', self._world)
"""
