Exemplo n.º 1
0
def refill():
	PyPR2.moveArmWithJointPos(**left_intermediate)
	PyPR2.moveHeadTo(0.1,0.3)
	time.sleep(3)
	PyPR2.moveArmWithJointPos(**right_refill)
	PyPR2.moveHeadTo(-0.7,0.3)
	time.sleep(3)
	PyPR2.moveHeadTo(-0.2,0.3)
	PyPR2.moveArmWithJointPos(**left_refill)
	time.sleep(4)
	PyPR2.moveArmWithJointPos(**right_pick)
	PyPR2.moveHeadTo(-0.2,0.19)
	time.sleep(2)
	PyPR2.closeGripper(2)
	time.sleep(3)
	PyPR2.moveArmWithJointPos(**right_pick_further)
	time.sleep(2)
	PyPR2.moveArmWithJointPos(**left_pick_further)
	time.sleep(4)
	PyPR2.moveArmWithJointPos(**r2)
	PyPR2.moveArmWithJointPos(**l2)
Exemplo n.º 2
0
def refill():
    PyPR2.moveArmWithJointPos(**left_intermediate)
    PyPR2.moveHeadTo(0.1, 0.3)
    time.sleep(3)
    PyPR2.moveArmWithJointPos(**right_refill)
    PyPR2.moveHeadTo(-0.7, 0.3)
    time.sleep(3)
    PyPR2.moveHeadTo(-0.2, 0.3)
    PyPR2.moveArmWithJointPos(**left_refill)
    time.sleep(4)
    PyPR2.moveArmWithJointPos(**right_pick)
    PyPR2.moveHeadTo(-0.2, 0.19)
    time.sleep(2)
    PyPR2.closeGripper(2)
    time.sleep(3)
    PyPR2.moveArmWithJointPos(**right_pick_further)
    time.sleep(2)
    PyPR2.moveArmWithJointPos(**left_pick_further)
    time.sleep(4)
    PyPR2.moveArmWithJointPos(**r2)
    PyPR2.moveArmWithJointPos(**l2)
Exemplo n.º 3
0
def revolve_acw():
	(a,b) = PyPR2.getHeadPos()
	#PyPR2.say("searching")
	PyPR2.moveHeadTo(a-0.3,0.0)
Exemplo n.º 4
0
def alt_bow_arrow():
	PyPR2.openGripper(2)
	PyPR2.moveHeadTo(0.0,0.15)
	PyPR2.moveArmWithJointPos(**left_shooting)
	PyPR2.openGripper(2)
	time.sleep(2)
	PyPR2.moveHeadTo(0.0,0.0)
	PyPR2.moveArmWithJointPos(**alt_right_intermediate)
	PyPR2.moveHeadTo(0.0,0.3)
	time.sleep(3)
	PyPR2.moveArmWithJointPos(**alt_right_shooting)
	time.sleep(3)
	PyPR2.closeGripper(2)
	time.sleep(2)
	PyPR2.moveHeadTo(0.0,0.18)
	PyPR2.moveArmWithJointPos(**best_pullback_right)
	
	
	time.sleep(5)
	PyPR2.moveHeadTo(0.0,0.1)
	PyPR2.openGripper(2)
	#PyPR2.moveHeadTo(0.0,0.0)
	PyPR2.moveArmWithJointPos(**alt_right_release)

	PyPR2.moveHeadTo(0.0,0.1)
Exemplo n.º 5
0
def revolve_acw():
    (a, b) = PyPR2.getHeadPos()
    #PyPR2.say("searching")
    PyPR2.moveHeadTo(a - 0.3, 0.0)
Exemplo n.º 6
0
def alt_bow_arrow():
    PyPR2.openGripper(2)
    PyPR2.moveHeadTo(0.0, 0.15)
    PyPR2.moveArmWithJointPos(**left_shooting)
    PyPR2.openGripper(2)
    time.sleep(2)
    PyPR2.moveHeadTo(0.0, 0.0)
    PyPR2.moveArmWithJointPos(**alt_right_intermediate)
    PyPR2.moveHeadTo(0.0, 0.3)
    time.sleep(3)
    PyPR2.moveArmWithJointPos(**alt_right_shooting)
    time.sleep(3)
    PyPR2.closeGripper(2)
    time.sleep(2)
    PyPR2.moveHeadTo(0.0, 0.18)
    PyPR2.moveArmWithJointPos(**best_pullback_right)

    time.sleep(5)
    PyPR2.moveHeadTo(0.0, 0.1)
    PyPR2.openGripper(2)
    #PyPR2.moveHeadTo(0.0,0.0)
    PyPR2.moveArmWithJointPos(**alt_right_release)

    PyPR2.moveHeadTo(0.0, 0.1)