예제 #1
0
def returnToStand():

    leftCurrent = 0
    for node in left:
        leftCurrent += xjus.getNodeAvgCurrent(node)

    rightCurrent = 0
    for node in right:
        rightCurrent += xjus.getNodeAvgCurrent(node)

    if leftCurrent > rightCurrent:
        first = right
        second = left
    else:
        first = left
        second = right

    for node in first:
        moveToFullRotation(node)

    wait()

    for node in second:
        moveToFullRotation(node)

    wait()

    for node in nodes:
        xjus.zeroPosition(node)
예제 #2
0
def returnToStand():

	leftCurrent = 0
	for node in left:
		leftCurrent += xjus.getNodeAvgCurrent(node)

	rightCurrent = 0
	for node in right:
		rightCurrent += xjus.getNodeAvgCurrent(node)

	if leftCurrent > rightCurrent:
		first = right
		second = left
	else:
		first = left
		second = right

	for node in first:
		moveToFullRotation(node)

	wait()

	for node in second:
		moveToFullRotation(node)

	wait()

	for node in nodes:
		xjus.zeroPosition(node)
예제 #3
0
def stand():
    """ Raises the chassis into a standing position """

    global standing
    standing = True

    for node in nodes:
        xjus.setPositionProfile(node, 500, 10000, 10000)

    for node in nodes:
        move(node, degToPos(STAND_ANGLE))

    wait()

    for node in nodes:
        xjus.zeroPosition(node)
예제 #4
0
def stand():
	""" Raises the chassis into a standing position """

	global standing
	standing = True

 	for node in nodes:
		xjus.setPositionProfile(node, 500, 10000, 10000)

	for node in nodes:
		move(node, degToPos(STAND_ANGLE))

	wait()
	
	for node in nodes:
		xjus.zeroPosition(node)