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_shoot = control_srv.shootControlSrv()
rospy.loginfo('the shoot is initial ok!')
def __init__(self):
smach.State.__init__(self, outcomes=['successed', 'failed'])
self.cmd_shoot = control_srv.shootControlSrv()
rospy.loginfo('the shoot is initial ok!')
def AdjustShoot(x, y, z):
move_cmd = world_move.world_move()
shoot_cmd = control_srv.shootControlSrv()
move_cmd.move_to(x, y, z)
rospy.sleep(0.5)
shoot_cmd.shoot_ball()