Skip to content
Snippets Groups Projects
Commit 412b12b6 authored by m-guberina's avatar m-guberina
Browse files

cm

parent 7924118d
No related branches found
No related tags found
No related merge requests found
No preview for this file type
No preview for this file type
...@@ -621,6 +621,7 @@ def controlLoopClikDualArmsOnly(robot : RobotManager, clik_controller, goal_tran ...@@ -621,6 +621,7 @@ def controlLoopClikDualArmsOnly(robot : RobotManager, clik_controller, goal_tran
qd_left = clik_controller(J_left, err_vector_left) qd_left = clik_controller(J_left, err_vector_left)
qd_right = clik_controller(J_right, err_vector_right) qd_right = clik_controller(J_right, err_vector_right)
qd = qd_left + qd_right qd = qd_left + qd_right
qd = np.hstack((np.zeros(3), qd))
robot.sendQd(qd) robot.sendQd(qd)
log_item['qs'] = q.reshape((robot.model.nq,)) log_item['qs'] = q.reshape((robot.model.nq,))
......
0% Loading or .
You are about to add 0 people to the discussion. Proceed with caution.
Please register or to comment