Control system, control method, and non-transitory computer readable medium storing control program

1 . A control system for controlling an operation of a mobile robot that comprises a wheel for moving the mobile robot, an arm, and an end effector connected to the arm, the control system comprising:

at least one memory storing instructions; and

at least one processor executing:

a parameter optimization processing for optimizing a rotational speed of the wheel and an angular velocity of joints of the arm that have been already calculated; and

a temporal trajectory optimization processing for optimizing a trajectory of the end effector by performing temporal trajectory optimization,

wherein the parameter optimization processing includes adjusting a weight of a rotational speed of the wheel and a weight of the angular velocity of the joints of the arm to be applied to the angular velocity of the joints of the arm so that the weight of the rotational speed of the wheel to be applied to the rotational speed of the wheel increases as the end effector approaches a target position of the end effector, whereby the angular velocity of the joints of the arm is minimized.

2 . The control system according to claim 1 , wherein

the parameter optimization processing maximizes manipulability of the arm using a Jacobian matrix that acts on the angular velocity of the joints of the arm, and

the Jacobian matrix includes: a value w representing manipulability of the arm; a transpose matrix (J arm H T ) T between a Jacobian matrix J arm and a transpose matrix H T of a Hessian matrix H, the Jacobian matrix J arm representing a relationship between the velocity of the end effector at the angular velocity of the joints of the arm; and an inverse matrix of the transpose matrix J arm T between the Jacobian matrix J arm and a transpose matrix of the Jacobian matrix J arm .

3 . The control system according to claim 1 , wherein the target rotational speed of the end effector is calculated by performing control to fill a deviation between a roll angle, a pitch angle, and a yaw angle that are target orientations of the end effector and a roll angle, a pitch angle, and a yaw angle that are current orientations of the end effector.

4 . A control method for controlling an operation of a mobile robot that comprises a wheel for moving the mobile robot, an arm, and an end effector connected to the arm, the method comprising causing a computer to execute:

a parameter optimization processing for optimizing a rotational speed of the wheel and an angular velocity of joints of the arm that have been already calculated; and

a temporal trajectory optimization processing for optimizing a trajectory of the end effector by performing temporal trajectory optimization,

wherein the parameter optimization processing includes adjusting a weight of a rotational speed of the wheel and a weight of the angular velocity of the joints of the arm to be applied to the angular velocity of the joints of the arm so that the weight of the rotational speed of the wheel to be applied to the rotational speed of the wheel increases as the end effector approaches a target position of the end effector, whereby the angular velocity of the joints of the arm is minimized.

5 . The control method according to claim 4 , wherein

the parameter optimization processing maximizes manipulability of the arm using a Jacobian matrix that acts on the angular velocity of the joints of the arm, and

the Jacobian matrix includes: a value w representing manipulability of the arm; a transpose matrix (J arm H T ) T between a Jacobian matrix J arm and a transpose matrix H T of a Hessian matrix H, the Jacobian matrix J arm representing a relationship between the velocity of the end effector at angular velocity of the joints of the arm; and an inverse matrix of the transpose matrix J arm T between the Jacobian matrix J arm and a transpose matrix of the Jacobian matrix J arm .

6 . The control method according to claim 4 , wherein the target rotational speed of the end effector is calculated by performing control to fill a deviation between a roll angle, a pitch angle, and a yaw angle that are target orientations of the end effector and a roll angle, a pitch angle and a yaw angle that are current orientations of the end effector.

7 . A non-transitory computer readable medium storing a control program for controlling an operation of a mobile robot that comprises a wheel for moving the mobile robot, an arm, and an end effector connected to the arm, the control program configured to cause a computer to execute:

a parameter optimization processing for optimizing a rotational speed of the wheel and an angular velocity of joints of the arm that have already been calculated; and

a temporal trajectory optimization processing for optimizing a trajectory of the end effector by performing temporal trajectory optimization,

wherein the parameter optimization processing includes adjusting a weight of a rotational speed weight of the wheel and a weight of the angular velocity of the joints of the arm to be applied to the angular velocity of the joints of the arm so that the weight of the rotational speed of the wheel to be applied to the rotational speed of the wheel increases as the end effector approaches a target position of end effector, whereby the angular velocity of the joints of the arm is minimized.

8 . The non-transitory computer readable medium according to claim 7 , wherein

the parameter optimization processing maximizes manipulability of the arm using a Jacobian matrix that acts on the angular velocity of the joints of the arm, and

the Jacobian matrix includes: a value w representing manipulability of the arm; a transpose matrix (J arm H T ) T between a Jacobian matrix J arm and a transpose matrix H T of a Hessian matrix H, the Jacobian matrix J arm representing a relationship between the velocity of the end effector at the angular velocity of the joints of the arm; and an inverse matrix of the transpose matrix J arm T between the Jacobian matrix J arm and a transpose matrix of the Jacobian matrix J arm .

9 . The non-transitory computer readable medium according to claim 7 , wherein the target rotational speed of the end effector is calculated by performing control to fill a deviation between a roll angle, a pitch angle, and a yaw angle that are target orientations of the end effector and a roll angle, a pitch angle, and a yaw angle that are current orientations of the end effector.