Exemplo n.º 1
0
def gravload(robot, q=None, grav=None):
    q = mat(q)
    if numcols(q) != robot.n:
        raise 'Insuficient columns in q'
    if grav == None and q != None:
        tg = rne(robot, q, zeros(shape(q)), zeros(shape(q)))
    elif grav != None and q != None:
        tg = rne(robot, q, zeros(shape(q)), zeros(shape(q)), grav)
    return tg
Exemplo n.º 2
0
def gravload(robot, q=None, grav=None):
        q = mat(q)
        if numcols(q) != robot.n:
                raise 'Insuficient columns in q'
        if grav == None and q != None:
                tg = rne(robot, q, zeros(shape(q)), zeros(shape(q)))
        elif grav != None and q != None:
                tg = rne(robot, q, zeros(shape(q)), zeros(shape(q)), grav)
        return tg
Exemplo n.º 3
0
def itorque(robot, q, qdd):
    return rne(robot, q, zeros(shape(q)), qdd, [[0],[0],[0]])
Exemplo n.º 4
0
def itorque(robot, q, qdd):
    return rne(robot, q, zeros(shape(q)), qdd, [[0],[0],[0]])