task_priority_ctrl(const MatrixXd &cam_vel, const bool &arm_unina, const bool &arm_catec, const bool &enable_sec_task, const Matrix4d &Tcam_in_tip, const Matrix4d &Ttag_in_cam, const MatrixXd &lambda_robot, const MatrixXd &gain_sec_task, const MatrixXd &q_rollpitch, const MatrixXd &v_rollpitch, const Chain &kdl_chain, const vector< arm_joint > joint_info, const double &dt, MatrixXd &q, MatrixXd &vel_quad) | KintonArmTaskPriorityControlAlgorithm | |