1. A grab control method, characterized by comprising the steps of:

acquiring the actual grabbing force, the actual angle and the actual position of the grabbing control device and the expected grabbing force of an object to be grabbed;

based on the actual grabbing force and the expected grabbing force, determining the position correction quantity of the object to be grabbed by applying an impedance control algorithm;

determining the expected position of the object to be grabbed by applying a preset parameter estimation algorithm based on the actual grabbing force, the actual position and the expected grabbing force;

determining a desired angle of the grasping control device by applying an inverse kinematics calculation method based on the position correction amount and the desired position; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

2. The method according to claim 1, wherein the determining the expected position of the object to be grabbed by applying a preset parameter estimation algorithm based on the actual grabbing force, the actual position and the expected grabbing force comprises:

based on the actual grabbing force and the actual position, a preset parameter estimation algorithm is applied to determine a position estimation value and a rigidity estimation value of the object to be grabbed;

determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force.

3. The method of claim 1, wherein the inverse kinematics calculation is formulated as:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂The joint angle of a second joint on one side of the grabbing control device is the joint angle; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin.

4. The method of claim 3, wherein x is summed from the position correction and the desired position; and the y is obtained according to the actual position.

5. A grip control apparatus, comprising:

the acquisition module is used for acquiring the actual grabbing force, the actual angle and the actual position of the grabbing control device and the expected grabbing force of the object to be grabbed;

the first processing module is used for determining the position correction quantity of the object to be grabbed by applying an impedance control algorithm based on the actual grabbing force and the expected grabbing force;

the second processing module is used for applying a preset parameter estimation algorithm to determine the expected position of the object to be grabbed based on the actual grabbing force, the actual position and the expected grabbing force;

the joint angle calculation module is used for determining an expected angle of the grabbing control device by applying an inverse kinematics calculation method based on the position correction quantity and the expected position; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

6. The method according to claim 5, wherein the second processing module is specifically configured to:

based on the actual grabbing force and the actual position, a preset parameter estimation algorithm is applied to determine a position estimation value and a rigidity estimation value of the object to be grabbed;

determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force.

7. The method of claim 1, wherein the inverse kinematics calculation is formulated as:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂Second for gripping one side of the control deviceJoint angle at the joint; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin.

8. The method of claim 7, wherein x is summed from the position correction and the desired position; and the y is obtained according to the actual position.

9. A storage medium storing program instructions, wherein the program instructions, when executed, implement the steps of the grab control method of any of claims 1-4.

10. A grip control apparatus, characterized by comprising:

the device comprises a grabbing control module, a front-end sensor, a position sensor, a force sensor, an angle sensor, an impedance controller, a parameter estimator and a proportional-integral-derivative controller;

the front end sensor is used for acquiring position point information of an object to be grabbed and expected grabbing force of the object to be grabbed and feeding back the information to the grabbing control module;

the position sensor is used for acquiring the actual position of the grabbing end of the grabbing control device and feeding the actual position back to the grabbing control module;

the force sensor is used for acquiring the actual grabbing force of the grabbing end and feeding the actual grabbing force back to the grabbing control module;

the angle sensor is used for acquiring the actual angle of the joint of the grabbing control device and feeding back the actual angle to the grabbing control module;

the impedance controller is used for determining the position correction quantity of the object to be grabbed based on the actual grabbing force and the expected grabbing force and feeding back the position correction quantity to the grabbing control module;

the parameter estimator is used for determining the expected position of the object to be grabbed based on the actual grabbing force, the actual position and the expected grabbing force, and feeding the expected position back to the grabbing control module;

the grabbing control module is used for controlling grabbing control equipment to move to the position of the object to be grabbed to accurately grab the object based on the position point information and the expected grabbing force; further for inputting the actual grip force and the desired grip force into the resistance controller; further for inputting the actual position, the actual grip force and the desired grip force into the parameter estimator; the controller is also used for determining a desired angle of the grabbing control device by applying an inverse kinematics calculation method based on the position correction quantity and the desired position; inputting the expected angle and the actual angle into the proportional-integral-derivative controller;

the proportional integral derivative controller is used for determining an angle adjustment amount of the grabbing control device based on the expected angle and the actual angle; and feeds back the data to the grabbing control module;

the grabbing control module is also used for controlling the grabbing control equipment to finish grabbing operation according to the angle adjustment quantity.

Background

Along with the development of intelligent manufacturing, more and more fields are applied to grabbing control devices such as manipulators and the like to complete grabbing operation, for example, the construction field applies the manipulators to grab construction waste, and the construction waste is easy to slip when the grabbing force of the manipulators is small due to various materials and different surface rigidity of the construction waste; when the grabbing force of the manipulator is large, the construction waste is easy to damage. Therefore, the control of the grasping by the grasping control means is a key point therein.

In the prior art, a grabbing control device mainly adopts an impedance control method for grabbing, and the method adjusts the dynamic relation between the position of a manipulator end effector and contact force according to a set target impedance model, and is widely applied to the aspects of fruit and vegetable grabbing, affected limb rehabilitation, working surface polishing, shaft hole assembly and the like; in the field of buildings, when an impedance control method is applied to grabbing and sorting, if the position and the surface rigidity of an object to be grabbed can be accurately obtained, quick and stable grabbing can be realized; in practical application, however, the information such as the position and the surface rigidity of the object to be grasped and the like estimated by the grasping control device through the sensor often has deviation; the surface rigidity of the object to be grabbed can also be changed in the grabbing process, and a good control effect cannot be obtained by applying an impedance control method; but can influence the sorting efficiency of the object to be grabbed.

Therefore, how to more accurately perform grasping by the grasping control device is an urgent problem to be solved.

Disclosure of Invention

In view of the above disadvantages of the prior art, the present invention provides a method and a device for controlling a grasping of a construction waste sorting manipulator, which are used to solve the problem of the prior art that the grasping cannot be performed more accurately.

To achieve the above and other related objects, the present invention provides a capture control method, comprising: acquiring the actual grabbing force, the actual angle and the actual position of the grabbing control device and the expected grabbing force of an object to be grabbed; based on the actual grabbing force and the expected grabbing force, determining the position correction quantity of the object to be grabbed by applying an impedance control algorithm; determining the expected position of the object to be grabbed by applying a preset parameter estimation algorithm based on the actual grabbing force, the actual position and the expected grabbing force; determining a desired angle of the grasping control device by applying an inverse kinematics calculation method based on the position correction amount and the desired position; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

In an embodiment of the present invention, the determining the expected position of the object to be grabbed by applying a preset parameter estimation algorithm based on the actual grabbing force, the actual position and the expected grabbing force includes: based on the actual grabbing force and the actual position, a preset parameter estimation algorithm is applied to determine a position estimation value and a rigidity estimation value of the object to be grabbed; determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force.

In an embodiment of the present invention, the formula expression of the inverse kinematics calculation method is:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂The joint angle of a second joint on one side of the grabbing control device is the joint angle; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin.

In an embodiment of the present invention, the x is obtained by summing the position correction amount and the desired position; and the y is obtained according to the actual position.

Correspondingly, the invention provides a grabbing control device, which comprises an acquisition module, a control module and a control module, wherein the acquisition module is used for acquiring the actual grabbing force, the actual angle and the actual position of the grabbing control device and the expected grabbing force of an object to be grabbed; the first processing module is used for determining the position correction quantity of the object to be grabbed by applying an impedance control algorithm based on the actual grabbing force and the expected grabbing force; the second processing module is used for applying a preset parameter estimation algorithm to determine the expected position of the object to be grabbed based on the actual grabbing force, the actual position and the expected grabbing force; the joint angle calculation module is used for determining an expected angle of the grabbing control device by applying an inverse kinematics calculation method based on the position correction quantity and the expected position; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

In an embodiment of the invention, the second processing module is specifically configured to: based on the actual grabbing force and the actual position, a preset parameter estimation algorithm is applied to determine a position estimation value and a rigidity estimation value of the object to be grabbed; determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force.

In an embodiment of the present invention, the formula expression of the inverse kinematics calculation method is:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂The joint angle of a second joint on one side of the grabbing control device is the joint angle; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin.

In an embodiment of the present invention, the x is obtained by summing the position correction amount and the desired position; and the y is obtained according to the actual position.

The present invention provides a storage medium having stored thereon a computer program which, when executed by a processor, implements the above-described grab control method.

The present invention provides a grasping control apparatus, characterized by comprising: the device comprises a grabbing control module, a front-end sensor, a position sensor, a force sensor, an angle sensor, an impedance controller, a parameter estimator and a proportional-integral-derivative controller; the front end sensor is used for acquiring position point information of an object to be grabbed and expected grabbing force of the object to be grabbed and feeding back the information to the grabbing control module; the position sensor is used for acquiring the actual position of the grabbing end of the grabbing control device and feeding the actual position back to the grabbing control module; the force sensor is used for acquiring the actual grabbing force of the grabbing end and feeding the actual grabbing force back to the grabbing control module; the angle sensor is used for acquiring the actual angle of the joint of the grabbing control device and feeding back the actual angle to the grabbing control module; the impedance controller is used for determining the position correction quantity of the object to be grabbed based on the actual grabbing force and the expected grabbing force and feeding back the position correction quantity to the grabbing control module; the parameter estimator is used for determining the expected position of the object to be grabbed based on the actual grabbing force, the actual position and the expected grabbing force, and feeding the expected position back to the grabbing control module; the grabbing control module is used for controlling grabbing control equipment to move to the position of the object to be grabbed to accurately grab the object based on the position point information and the expected grabbing force; further for inputting the actual grip force and the desired grip force into the resistance controller; further for inputting the actual position, the actual grip force and the desired grip force into the parameter estimator; the controller is also used for determining a desired angle of the grabbing control device by applying an inverse kinematics calculation method based on the position correction quantity and the desired position; inputting the expected angle and the actual angle into the proportional-integral-derivative controller; the proportional integral derivative controller is used for determining an angle adjustment amount of the grabbing control device based on the expected angle and the actual angle; and feeds back the data to the grabbing control module; the grabbing control module is also used for controlling the grabbing control equipment to finish grabbing operation according to the angle adjustment quantity.

As described above, the construction waste sorting manipulator grabbing control method and device of the invention have the following beneficial effects:

(1) the application of the parameter estimation algorithm ensures that the grabbing control device can still make self-adaptive adjustment to realize stable grabbing when the position and the surface rigidity of the object to be grabbed are estimated to have deviation or the surface rigidity of the object to be grabbed changes in the grabbing process.

(2) The impedance control algorithm and the parameter estimation algorithm are combined, so that the robustness of the algorithm is obviously improved, and the sorting efficiency of the objects to be grabbed is ensured.

Drawings

Fig. 1 is a flowchart illustrating a capture control method according to an embodiment of the invention.

Fig. 2 is a schematic coordinate diagram of a simplified model of a capture control method according to an embodiment of the invention.

Fig. 3 is a diagram illustrating an example of a work flow of the capture control method according to an embodiment of the invention.

Fig. 4 is a schematic diagram showing the variation of the gripping force when there is no deviation between the estimated position of the object to be gripped and the surface rigidity in the gripping control method according to an embodiment of the present invention.

Fig. 5 is a schematic diagram illustrating a change in gripping force when the estimated surface stiffness of the object to be gripped deviates according to an embodiment of the gripping control method of the present invention.

Fig. 6 is a schematic diagram illustrating a change of the grasping force when the position of the object to be grasped is estimated to be deviated according to an embodiment of the grasping control method of the invention.

Fig. 7 is a schematic view showing a change in gripping force when there is a change in surface rigidity of an object to be gripped during gripping in an embodiment of the gripping control method of the present invention.

Fig. 8 is a schematic structural diagram of a capture control device according to an embodiment of the invention.

Fig. 9 shows a grabbing control device of the grabbing control device in one embodiment of the invention.

Description of the element reference numerals

81 acquisition module

82 first processing module

83 second processing module

84 joint angle calculation module

91 grabbing control module

92 front end sensor

93 position sensor

94 force sensor

95 angle sensor

96 impedance controller

97 parameter estimator

98 proportion integral derivative controller

Detailed Description

The embodiments of the present invention are described below with reference to specific embodiments, and other advantages and effects of the present invention will be easily understood by those skilled in the art from the disclosure of the present specification. The invention is capable of other and different embodiments and of being practiced or of being carried out in various ways, and its several details are capable of modification in various respects, all without departing from the spirit and scope of the present invention. It is to be noted that the features in the following embodiments and examples may be combined with each other without conflict.

It should be noted that the drawings provided in the following embodiments are only for illustrating the basic idea of the present invention, and the components related to the present invention are only shown in the drawings rather than drawn according to the number, shape and size of the components in actual implementation, and the type, quantity and proportion of the components in actual implementation may be changed freely, and the layout of the components may be more complicated.

The construction waste sorting manipulator grabbing control method and device disclosed by the invention apply a parameter estimation algorithm to ensure that the grabbing control device can still make self-adaptive adjustment to realize stable grabbing when the estimated position and surface rigidity of the object to be grabbed have deviation or the surface rigidity of the object to be grabbed changes in the grabbing process; and the impedance control algorithm and the parameter estimation algorithm are combined, so that the robustness of the algorithm is obviously improved, and the sorting efficiency of the objects to be grabbed is ensured.

As shown in fig. 1, in the present embodiment, the grabbing control method of the invention includes the following steps:

and step S1, acquiring the actual gripping force, the actual angle, the actual position and the expected gripping force of the object to be gripped by the gripping control device.

Specifically, the grabbing control device is provided with a front end sensor, and position point information of an object to be grabbed and expected grabbing force of the object to be grabbed are acquired through the front end sensor; in addition, the front-end sensor can also acquire the volume and material information of the object to be grabbed; according to the acquired position point information of the object to be grabbed, the grabbing control device moves to the position close to the object to be grabbed; meanwhile, a force sensor, a position sensor and an angle sensor are arranged at the grabbing end of the grabbing control device, and the actual grabbing force between the grabbing end and the grabbed object is measured through the force sensor; measuring the actual position of the grabbing end through a position sensor; the actual angle of the joint of the grabbing control device is measured through the angle sensor.

And step S2, based on the actual gripping force and the expected gripping force, applying an impedance control algorithm to determine the position correction quantity of the object to be gripped.

Specifically, the actual gripping force is compared with the expected gripping force to obtain a gripping force error; and applying an impedance control algorithm to the gripping force error to determine the position correction of the object to be gripped, wherein the application of the impedance control algorithm can be in the form of an impedance controller.

More specifically, an actual grip force is defined as F, and an expected grip force is defined as F_dThe impedance control algorithm is applied as follows.

The first step, the grabbing end of the grabbing control device and an environment system are equivalent to a linear spring, and the formula expression is as follows:

wherein: x represents the actual position of the grasping end of the grasping control device; x_eIndicating the position of the object to be grasped; k_eRepresenting the stiffness of the object to be grasped.

And step two, setting a target impedance control model, wherein the formula expression is as follows:

wherein: x, X,Respectively representing the actual position, the actual speed and the actual acceleration of the grabbing end of the grabbing control device; x_d、Respectively representing the target position, the target speed and the target acceleration of the grabbing end of the grabbing control device; m is_dRepresenting a target inertia; b_dRepresenting a target damping; k is a radical of_dRepresenting the target stiffness. The purpose of impedance control is to select active control parameters to achieve the desired target impedance.

Thirdly, defining a position correction vector delta X-X_dError of grasping force E_f＝F_dF, obtaining the position correction quantity delta X and the gripping force error E from the formula expression (2)_fThe formula expression satisfied is:

fourthly, performing Laplace transformation on the formula expression (3) to obtain a transfer function of the impedance controller as follows:

the position correction quantity of the object to be grabbed is obtained by the formula expression (4).

And step S3, based on the actual grabbing force, the actual position and the expected grabbing force, applying a preset parameter estimation algorithm to determine the expected position of the object to be grabbed.

Specifically, a preset parameter estimation algorithm is applied based on the actual grasping force and the actual position to determine a position estimation value and a rigidity estimation value of the object to be grasped; determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force. Defining the actual position as X and the position estimation value asThe stiffness estimate isAnd the desired position is Xd, where the application of the parameter estimation algorithm may take the form of a parameter estimator.

Further specifically, the application process of the parameter estimation algorithm is as follows.

In the first step, according to formula (1), the formula defining the desired position Xd is:

defining predicted gripThe formula expression of (1) is:

in actual operation, the expected position Xd and the predicted valueCan estimate the rigidity according to the rigidity of the object to be grabbed at the current momentAnd a position estimateAnd calculating in real time.

In the second step, the formula expression of the predefined relational equation is:

φ＝[φ_k φ_x]^T (7)

wherein the content of the first and second substances,the rigidity estimated value of the object to be grabbed and the difference value of the rigidity are obtained;multiplying the position estimated value of the object to be grabbed and the difference value of the positions by the rigidity estimated value;is composed ofAndand (4) transposing the formed one-dimensional array.

Subtracting the first formula of formula (1) from formula (6), and applying formula (7)And expressing, wherein a formula expression for obtaining the error between the predicted gripping force and the actual gripping force is as follows:

the rigidity estimated value of the object to be grabbed is adjusted according to the errorAnd a position estimateSo that when time t → ∞ is reachedI.e. the predicted grip force can converge to the actual grip force.

Further specifically, the relationship among the preset actual gripping force, the predicted gripping force and the expected gripping force is as follows: if it can proveCan converge to F, then F → F_dThat is, the actual gripping force is able to tend toward the desired gripping force under the condition that the predicted gripping force converges to the actual gripping force. Therefore, based on the relationship among the three gripping forces, the formula expression of the energy function V constructed using the leipimov stability theorem is:

V＝φ^TΠφ (9)

wherein pi is a given second-order positive definite matrix,is composed ofThe transposing of (1).

Hypothesis pairDerived fromThe formula expression of (1) is:

derived from the energy function V by combining the expressions (8), (9) and (10)The formula expression of (1) is:

wherein the content of the first and second substances,is a semi-negative definite matrix; as can be seen from the concept of the semi-negative definite matrix, if Φ can satisfy the formula expression (10), when t → ∞,can converge on F, thus F → F_d。

Thirdly, combining the formula and the proof conclusion to obtain the pairDerivation ofAnd pairDerivation ofThe formula expression of (1) is:

wherein ξ₁And xi₂Is a normal number.

And fourthly, synthesizing the formula expressions in the three steps to obtain a formula expression of complete parameter estimation, wherein the formula expression of the complete parameter estimation is as follows:

wherein the content of the first and second substances,andand respectively at the moment t is equal to 0, and the rigidity estimated value and the position estimated value of the object to be grabbed are preset values.

Through the application of the parameter estimation algorithm in the step S3, the rigidity and the position of the object to be grasped can be estimated online, so as to obtain the rigidity estimation value and the position estimation value of the object to be grasped, and then the expected position of the object to be grasped can be obtained through real-time calculation according to the estimation values.

Step S4, based on the position correction quantity and the expected position, applying an inverse kinematics calculation method to determine an expected angle of the grabbing control device; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

Specifically, the formula expression of the inverse kinematics calculation method is as follows:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂The joint angle of a second joint on one side of the grabbing control device is the joint angle; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin. As shown in FIG. 2, in the present embodiment, the simplified model of the present inventionThe grabbing end of the grabbing control device in the drawing is a mode of a two-finger two-degree-of-freedom planar manipulator, and the two fingers of the manipulator and an object to be grabbed are set to be symmetrical about a Y axis, so that only one of the left side and the right side is analyzed.

More specifically, x is obtained by summing the position correction and the expected position; the y is derived from the actual position, e.g. y may remain unchanged in case of grabbing considering a one-dimensional mode.

Further specifically, after the expected angle of the grabbing control device is determined, the expected angle and the actual angle are subtracted to obtain an angle error, and then a proportional-integral-derivative control method is applied to determine the control quantity of each joint in real time, so that the grabbing end can perform grabbing adjustment in real time according to the expected angle of each joint without static error and according to the determined control quantity, the actual grabbing force reaches the expected grabbing force, and therefore the grabbing control device can be adaptively flexibly adjusted under the condition that the position and the surface rigidity of the object to be grabbed are estimated to be deviated or the surface rigidity of the object to be grabbed is changed in the grabbing process, so that grabbing operation can be completed more accurately. For example, in the field of construction, after the construction waste is captured by the method, the construction waste can be moved to a designated position according to a preset track to release the construction waste, so that a sorting task is completed.

Through the method of the steps S1-S4, the gripping control device can still make self-adaptive adjustment to realize stable gripping when the position and the surface rigidity of the object to be gripped are estimated to have deviation or the surface rigidity of the object to be gripped changes in the gripping process; the sorting efficiency of the objects to be grabbed is ensured; as shown in fig. 3, in the embodiment, a working flow example diagram of the invention is shown.

As shown in fig. 4, in the present embodiment, a schematic diagram of the change of the gripping force when there is no deviation between the estimated position of the object to be gripped and the surface rigidity is shown; simulation results show that under the condition setting, the grabbing control device quickly and stably finishes grabbing tasks.

As shown in fig. 5, in the present embodiment, a schematic diagram of the variation of the gripping force when the estimated surface stiffness of the object to be gripped has a deviation is shown; the condition set here is that there is no deviation in the positional information of the object to be grasped, and there is a deviation of 3000N/m in the surface rigidity information; simulation results show that under the condition setting, the grabbing control device adjusts the adaptive parameters through the method, the overshoot of the grabbing force is slightly increased, and the grabbing task can be rapidly and stably completed.

As shown in fig. 6, in the present embodiment, a schematic diagram of the variation of the grasping force when the estimated position of the object to be grasped deviates is shown; the condition set here is that there is no deviation in the rigidity information of the object to be grasped, and there is a deviation of 0.1mm in the position information; simulation results show that under the condition setting, the grabbing control device adjusts the self-adaptive parameters through the method, the overshoot of the grabbing force is obviously increased, the grabbing time is prolonged, both the overshoot and the grabbing time are within an allowable range, and the grabbing task can be rapidly and stably completed.

As shown in fig. 7, in the present embodiment, a schematic diagram of the change of the gripping force when the surface rigidity of the object to be gripped changes in the gripping process of the present invention; the set condition is that when the grabbing control device stably grabs the object to be grabbed, the rigidity of the object to be grabbed changes suddenly, for example, the rigidity is increased by 3000N/m within 1.5s to 1.6s, and simulation results show that under the set condition, the grabbing control device can quickly respond and timely adjust through the self-adaptive parameter adjustment of the method, so that the grabbing force is quickly stabilized to a desired value.

As shown in fig. 8, in an embodiment, the grabbing control device of the present invention includes:

an obtaining module 81, configured to obtain an actual grasping force, an actual angle, an actual position, and an expected grasping force of an object to be grasped of the grasping control device;

a first processing module 82, configured to apply an impedance control algorithm based on the actual gripping force and the expected gripping force, and determine a position correction amount of the object to be gripped;

a second processing module 83, configured to apply a preset parameter estimation algorithm based on the actual grasping force, the actual position, and the expected grasping force, to determine an expected position of the object to be grasped;

a joint angle calculation module 84 for determining a desired angle of the grasping control device by applying an inverse kinematics calculation method based on the position correction amount and the desired position; the expected angle is used for comparing with the actual angle to adjust the actual angle of the grabbing control device so as to complete grabbing operation.

The second processing module 83 is specifically configured to:

based on the actual grabbing force and the actual position, a preset parameter estimation algorithm is applied to determine a position estimation value and a rigidity estimation value of the object to be grabbed;

determining an expected position of the object to be grabbed based on the position estimate, the stiffness estimate, and the expected grabbing force.

The formula expression of the inverse kinematics calculation method is as follows:

wherein, theta₁For grasping the joint angle, theta, at the first joint on one side of the control device₂The joint angle of a second joint on one side of the grabbing control device is the joint angle; l₁Is the length of the connection at the first joint and the second joint; l₂The length of the connection from the second joint to the grabbing end; x is an abscissa value of a two-dimensional coordinate with the first joint as an origin; y is a longitudinal coordinate value of a two-dimensional coordinate with the first joint as an origin. The x is obtained by summing the position correction quantity and the expected position; and the y is obtained according to the actual position.

The technical features of the specific implementation of the capture control device in this embodiment are basically the same as the principles of the steps in the capture control method in embodiment 1, and the general technical contents between the method and the device are not repeated.

The storage medium of the present invention stores thereon a computer program that realizes the above-described grab control method when executed by a processor.

As shown in fig. 9, in an embodiment, the grabbing control apparatus of the present invention includes:

the device comprises a grabbing control module 91, a front end sensor 92, a position sensor 93, a force sensor 94, an angle sensor 95, an impedance controller 96, a parameter estimator 97 and a proportional-integral-derivative controller 98;

the front end sensor 92 is used for acquiring position point information of an object to be grabbed and expected grabbing force of the object to be grabbed, and feeding the information back to the grabbing control module;

the position sensor 93 is configured to acquire an actual position of a grasping end of the grasping control device, and feed the actual position back to the grasping control module;

the force sensor 94 is used for acquiring the actual grabbing force of the grabbing end and feeding the actual grabbing force back to the grabbing control module;

the angle sensor 95 is configured to acquire an actual angle at a joint of the grasping control device and feed the actual angle back to the grasping control module;

the impedance controller 96 is configured to determine a position correction amount of the object to be grabbed based on the actual grabbing force and the expected grabbing force, and feed the position correction amount back to the grabbing control module;

the parameter estimator 97 is configured to determine an expected position of the object to be grasped based on the actual grasping force, the actual position, and the expected grasping force, and feed back the expected position to the grasping control module;

the grabbing control module 91 is used for controlling grabbing control equipment to move to the position of the object to be grabbed to accurately grab the object based on the position point information and the expected grabbing force; further for inputting the actual grip force and the desired grip force into the resistance controller; further for inputting the actual position, the actual grip force and the desired grip force into the parameter estimator; the controller is also used for determining a desired angle of the grabbing control device by applying an inverse kinematics calculation method based on the position correction quantity and the desired position; inputting the expected angle and the actual angle into the proportional-integral-derivative controller;

the pid controller 98 is configured to determine an angle adjustment amount of the grasping control device based on the desired angle and the actual angle; and feeds back the data to the grabbing control module;

the grabbing control module 91 is further configured to control the grabbing control device to complete grabbing operations according to the angle adjustment amount.

In conclusion, the construction waste sorting manipulator grabbing control method and device provided by the invention apply a parameter estimation algorithm, so that the grabbing control device can still make self-adaptive adjustment to realize stable grabbing when the position and the surface rigidity of the object to be grabbed are estimated to have deviation or the surface rigidity of the object to be grabbed is changed in the grabbing process; and the impedance control algorithm and the parameter estimation algorithm are combined, so that the robustness of the algorithm is obviously improved, and the sorting efficiency of the objects to be grabbed is ensured. Therefore, the invention effectively overcomes various defects in the prior art and has high industrial utilization value.

The foregoing embodiments are merely illustrative of the principles and utilities of the present invention and are not intended to limit the invention. Any person skilled in the art can modify or change the above-mentioned embodiments without departing from the spirit and scope of the present invention. Accordingly, it is intended that all equivalent modifications or changes which can be made by those skilled in the art without departing from the spirit and technical spirit of the present invention be covered by the claims of the present invention.