|
| | 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 = 1 |
| |
| | gravity |
| |
| | 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 = lambdaq,vq:pin.nle(robot.model,robot.data,q,vq) |
| |
| | robot |
| |
| | vq = rand(robot.model.nv) |
| |
| int | vq1 = vq*0 |
| |
| | vrnea = VRNEA(robot) |
| |