|
| aq = rand(robot.model.nv) |
|
| C = np.zeros([robot.model.nv,]*3) |
|
| coriolis = Coriolis(robot) |
|
| dcrba = DCRBA(robot) |
|
| dM = np.zeros([robot.model.nv,]*3) |
|
| dq = zero(robot.model.nv) |
|
| drnea = DRNEA(robot) |
|
int | eps = 1e-6 |
|
| gravity |
|
def | H = hessian(robot,q) |
|
| Htrue = np.zeros([6,robot.model.nv,robot.model.nv]) |
|
| Mp = dcrba() |
|
| NV = robot.model.nv |
|
| q = norm(q[3:7]) |
|
| Q = vrnea(q) |
|
| qdq = pin.integrate(robot.model,q,dq) |
|
| R = drnea(q,vq,aq) |
|
| r0 = pin.rnea(robot.model,robot.data,q,vq,aq).copy() |
|
| Rd = zero([NV,NV]) |
|
| rnea0 = lambda q,vq: pin.nle(robot.model,robot.data,q,vq) |
|
| robot |
|
| vq = rand(robot.model.nv) |
|
int | vq1 = vq*0 |
|
| vrnea = VRNEA(robot) |
|