System for Humanized Control of Quadruped Bionic Robot and Control Method Thereof
20190134825 ยท 2019-05-09
Inventors
Cpc classification
International classification
B25J13/08
PERFORMING OPERATIONS; TRANSPORTING
Abstract
The present disclosure relates to a system for humanized control of a quadruped bionic robot and a control method thereof, wherein an operator's intent of control is realized via a control cord, the magnitude, direction and time sequence of a force applied by the operator act upon a control sensor, a control processing unit processes a sensed signal and outputs a corresponding control signal to a corresponding drive motor to control the quadruped bionic robot. The control method is simple as the interaction between the robot and the operator is more direct.
Claims
1. A system for controlling a quadruped bionic robot, comprising a robot body, and drive motors for respectively controlling corresponding quadruped movement of the robot body, wherein the system further comprises: a control cord for applying a control action to a control sensing unit; a control sensing unit for sensing a control action of the control cord and sending a sensed signal of the control action of the control cord to a control processing unit; and a control processing unit for setting control signals corresponding to different sensed signals, receiving and processing the sensed signal from the control sensing unit, and outputting the control signal corresponding to a sensed signal to a corresponding drive motor to control the robot body to perform a corresponding action; the control cord being connected to the surface of the robot body, the output of the control sensing unit being connected with the input of the control processing unit, and the output of the control processing unit being connected with the drive motors respectively.
2. The system for controlling a quadruped bionic robot of claim 1, wherein the control sensing unit is a force vector sensor, and the control cord is sleeved on the surface of the force vector sensor; the control cord performs a control action to act upon the force vector sensor, the force vector sensor senses the direction of a force of the control action of the control cord, and sends a sensed signal to the control processing unit, and the control processing unit processes the sensed signal and outputs a control signal corresponding to the sensed signal to a corresponding drive motor.
3. The system for controlling a quadruped bionic robot of claim 1, wherein the control sensing unit is a motor current sensor, the motor current sensors are consistent with the drive motors in quantity and are respectively connected with the drive motors, and the control cord is secured to the surface of the robot body; the control cord performs a control action that generates an acting force onto the robot body, the robot body is under force and acts upon a corresponding drive motor to cause current of the drive motor under force to change, a motor current sensor senses the change of the current of the drive motor and sends a sensed signal to the control processing unit, and the control processing unit processes the sensed signal and outputs a control signal corresponding to the sensed signal to the corresponding drive motor.
4. A control method for applying the system for controlling a quadruped bionic robot of claim 1, comprising the following steps: S1. setting control signals corresponding to different sensed signals with a control processing unit; S2. performing a control action onto the robot body with a control cord; S3. a control sensing unit sensing the control action of the control cord and sending a sensed signal of the control action of the control cord to the control processing unit; and S4. the control processing unit receiving and processing the sensed signal from the control sensing unit, and outputting a control signal corresponding to the sensed signal to a corresponding drive motor to control the robot body to perform a corresponding action.
5. The control method for a quadruped bionic robot of claim 4, wherein in the step S3, the control sensing unit is a force vector sensor, the control cord performs a control action to act upon a force vector sensor, and the force vector sensor senses the direction of a force of the control action of the control cord and sends a sensed signal to the control processing unit.
6. The control method for a quadruped bionic robot of claim 4, wherein in step S3, the control sensing unit is a motor current sensor, the motor current sensors are consistent with the drive motors in quantity and are respectively connected with the drive motors; the control cord performs a control action that generates an acting force onto the robot body, the robot body is under force and acts upon a corresponding drive motor to cause the current of the drive motor under force to change, and a motor current sensor senses the change of the current of the drive motor and sends a sensed signal to the control processing unit.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0018]
[0019]
[0020]
DETAILED DESCRIPTION
[0021] The present invention is further described below with reference to specific embodiments.
[0022] Embodiment I:
[0023] Referring to
[0024] Wherein the control sensing units is a force vector sensor, and a control method is as below: [0025] S1. setting control signals corresponding to different sensed signals in advance with the control processing unit; [0026] S2. performing a control action onto the robot body with the control cord; [0027] S3. sensing a control action of the control cord and sending a sensed signal of the control action of the control cord to the force vector sensor that senses the magnitude and direction of a pull force applied by the operator to the control cord and produces a corresponding sensed signal, e.g. a sensed signal of standing for pulling up, a sensed signal of advancing for pulling forward, a sensed signal of halt for pulling backward, a sensed signal of left or right turning for pulling left or right, a sensed signal of fast action performing for pulling strongly and a sensed signal of gentle and slow action performing for pulling gently, and that sends said sensed signal to the control processing unit; and [0028] S4. the control processing unit receiving and processing the sensed signal, and outputting a control signal corresponding to the sensed signal to a corresponding drive motor to control the robot body to perform a corresponding action, thus realizing the control over the robot body.
[0029] As a preferred embodiment, to achieve a more accurate control over the robot body, a control cord can be directly bound on a corresponding force vector sensor to improve the sensing accuracy by directly acting upon the force vector sensor.
[0030] Embodiment II:
[0031] Referring to
[0032] As a preferred embodiment, since the current change signal is generated by the control cord acting upon the robot body and then acting upon a specific drive motor via the robot body and is sensed by the motor current sensor, the magnitude and direction of the force applied by the operator to the control cord is indirectly obtained. To achieve a more accurate control over the robot body, the control cord is disposed at a center of the four drive motors so that the magnitude and direction of the force applied by the operator are more uniform and the sensing accuracy is improved.
[0033] The above detailed description is merely a description of the preferred embodiments of the invention and by no means limits the scope of the invention. Without departing from the design spirit of the invention, various variations and improvements made by those ordinary skilled in the art shall all fall within the scope defined by the claims of the invention.