def __init__(self):
smach.State.__init__(self,outcomes=['successed','failed'])
self.move_cmd = linear_move.linear_move()
self.turn_cmd = turn_an_angular.turn_an_angular()
self.cmd_position = get_robot_position.robot_position_state()
self.cmd_shovel = control_srv.shovelControlSrv()
rospy.loginfo('The Shoot_Adjust is initial ok!!!!')
def __init__(self):
smach.State.__init__(self, outcomes=['successed', 'failed'])
self.move_cmd = move_in_robot.linear_move()
self.turn_cmd = turn_an_angular.turn_an_angular()
self.cmd_shovel = control_srv.shovelControlSrv()
self.find_ball = find_basketball.find_basketball()
self.cmd_position = get_robot_position.robot_position_state()
def __init__(self):
smach.State.__init__(self, outcomes=['successed', 'failed'])
self.move_cmd = move_in_robot.linear_move()
self.cmd_position = get_robot_position.robot_position_state()
self.cmd_shoot = control_srv.shootControlSrv()
self.cmd_shovel = control_srv.shovelControlSrv()
self.find_cylinder = find_cylinder.find_cylinder()
rospy.loginfo('The shoot is initial ok!')
def __init__(self):
smach.State.__init__(self, outcomes=['successed', 'failed'])
self.cmd_shovel = control_srv.shovelControlSrv()
def __init__(self):
smach.State.__init__(self,outcomes=['successed','failed'])
self.move_cmd = linear_move.linear_move()
self.turn_cmd = turn_an_angular.turn_an_angular()
self.cmd_shovel = control_srv.shovelControlSrv()
rospy.loginfo("the Move To Find BAll is initial Ok!")
def __init__(self):
smach.State.__init__(self, outcomes=['successed', 'failed'])
self.cmd_shovel = control_srv.shovelControlSrv()
rospy.loginfo('the first shovel is initial ok!')
def __init__(self):
smach.State.__init__(self,outcomes=['successed','failed'])
self.cmd_shovel = control_srv.shovelControlSrv()
rospy.loginfo("the Shovel_Control_Up is initial OK!")
