Disclosure of Invention
Aiming at the technical problems, the invention adopts the following technical scheme:
a data processing system for controlling grapple reclaiming, the system comprising: a controller and a memory storing a computer program which, when executed by the controller, performs the steps of:
s1, acquiring B, wherein B is a first height value corresponding to a target grab bucket in a target portal crane, and B meets the following conditions:
B=C z -D z -H 0 ,C z d is a coordinate value on a Z axis in a first three-dimensional coordinate corresponding to a center point of the bottom of the target grab bucket in the target 3D model z A second height value H corresponding to a preset material taking position in the target 3D model 0 For a preset height value, the target 3D model is a 3D model obtained by scanning materials in a target portal crane and a target ship cabin by using a multi-line laser radar, each position in the target 3D model corresponds to a first three-dimensional coordinate, and each first three-dimensional coordinate is generated based on a preset three-dimensional coordinate system.
S2, enabling the controller to send out a first instruction, wherein the first instruction is used for controlling the target grab bucket, so that the target grab bucket is accelerated to descend by the height B according to the first preset acceleration.
S3, enabling the controller to send out a second instruction, wherein the second instruction is used for controlling the target grab bucket, enabling the target grab bucket to accelerate and descend according to a second preset acceleration and receiving the torque output by the target torque sensor in real time, and the target torque sensor is arranged on the target portal crane and used for detecting the torque applied to the target grab bucket, and the torque is the vector product between the force action point and the force direction vector.
S4, if the moment received by the controller at the current time point is smaller than G 0 And all the moments received by the controller in the preset time period are smaller than G 0 The controller sends out a third instruction which is used for controlling the target grab bucket to stop descending, G 0 For presetting moment, presetting timeThe ending time point of the interval is DQ, DQ is the current time point, the starting time point of the preset time period is QS, QS=DQ-t, and t is the preset time length.
S5, acquiring S, wherein S is a depth value corresponding to the target grab bucket, and the depth value is a vertical height distance between a bottom center point of the target grab bucket and a preset material taking position when the target grab bucket takes materials, and the S meets the following conditions:
S=K 1 +K 2 ×M+K 3 ×M 2 m is the preset material taking weight; k (K) 1 、K 2 、K 3 Meets the following conditions:
[K 1 ,K 2 ,K 3 ] T =(M1 T ×M1) -1 ×M1 T x SD, M1 is the first matrix, SD is the second matrix;
m1 meets the following conditions:
M0 e the method comprises the steps that the weight of a material obtained when the material in a target ship cabin is fetched for the e-th time of a target grab before the current time point, wherein the value of e is 1 to f, and f is the number of times that the material in the target ship cabin is fetched by the target grab before the current time point;
SD meets the following conditions:
SD=[S0 1 ,S0 2 ,…,S0 e ,…,S0 f ] T ,S0 e and when the material in the cabin of the target ship is fetched for the e-th time of the target grab before the current time point, the vertical height distance between the bottom center point of the target grab and the material fetching position is kept.
And S6, enabling the controller to send out a fourth instruction, wherein the fourth instruction is used for controlling the target grab bucket, so that the target grab bucket descends by the height S and then takes materials.
The invention has at least the following beneficial effects:
according to the invention, the data processing system can acquire the first height value B corresponding to the target grab bucket in the target portal crane, the target grab bucket is controlled by the controller to descend according to the first preset acceleration, the target grab bucket is controlled by the controller to descend according to the second preset acceleration and receive the moment output by the target moment sensor in real time, if the moment received by the controller at the current time point is smaller than the preset moment and all moments received by the controller in the preset time period are smaller than the preset moment, the controller is controlled by the controller to stop descending of the target grab bucket, the depth value S corresponding to the target grab bucket is acquired according to the vertical height distance between the center point of the bottom of the target grab bucket and the material taking position when the target grab bucket takes material in the cabin each time before the current time point, the depth value S corresponding to the target grab bucket is acquired, the vertical height distance between the center point of the bottom of the target grab bucket and the preset position when the target grab bucket takes material taking is acquired, the vertical height value S corresponding to the material taking position can be calculated, the material taking efficiency can be prevented from being wasted when the weight of the material taking cabin is acquired by the conventional material taking position when the weight sensor is lower than the bottom of the material taking position.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without making any inventive effort, are intended to fall within the scope of the invention.
An embodiment of the present invention provides a data processing system for controlling grapple material taking, the system including: a controller and a memory storing a computer program which, when executed by the controller, performs the steps of, as shown in fig. 1:
s1, acquiring B, wherein B is a first height value corresponding to a target grab bucket in a target portal crane, and B meets the following conditions:
B=C z -D z -H 0 ,C z d is a coordinate value on a Z axis in a first three-dimensional coordinate corresponding to a center point of the bottom of the target grab bucket in the target 3D model z A second height value H corresponding to a preset material taking position in the target 3D model 0 For preset height values, the target 3D model is a 3D model obtained by scanning materials in a target portal crane and a target ship cabin by using a multi-line laser radar, each position in the target 3D model corresponds to a first three-dimensional coordinate, each first three-dimensional coordinate is generated based on a preset three-dimensional coordinate system, the preset material taking position is known to a person skilled in the art, the preset material taking position is preset by the person skilled in the art according to actual requirements, and the preset height value is preset by the person skilled in the art according to actual requirements and is not repeated here.
Specifically, the first height value is measured in centimeters.
Specifically, the coordinate value on the X-axis in the first three-dimensional coordinate corresponding to the center point of the bottom of the target grab bucket in the target 3D model is equal to the coordinate value on the X-axis in the first three-dimensional coordinate corresponding to the preset material taking position in the target 3D model.
Specifically, the coordinate value on the Y axis in the first three-dimensional coordinate corresponding to the center point of the bottom of the target grab bucket in the target 3D model is equal to the coordinate value on the Y axis in the first three-dimensional coordinate corresponding to the preset material taking position in the target 3D model.
Optionally, the multi-line laser radar is a laser rotation range radar that simultaneously transmits and receives multiple beams of laser light.
Optionally, the multi-line lidar is disposed at a front end of a trunk bridge in the target gantry crane.
Optionally, the preset three-dimensional coordinate system uses the center of the target 3D model as an origin O, uses a plane that passes through the origin O and is parallel to a plane where the bottom of the target gantry crane is located in the target 3D model as an XOY plane, and uses an upward direction perpendicular to the XOY plane as a positive Z-axis direction, where those skilled in the art know that the positive X-axis and Y-axis directions are set by those skilled in the art according to actual needs, and will not be described herein.
Optionally, the origin O of the preset three-dimensional coordinate system may also be set by a person skilled in the art according to actual needs, which is not described herein again; for example: and taking the bottom center of the target grab bucket in the target 3D model as an origin O.
Specifically, the Z axis of the preset three-dimensional coordinate system is used to characterize the height of the XOY plane upward or downward, wherein the measurement unit of the numerical value representing the height is centimeter.
Through the steps, the multi-line laser radar is used for scanning materials in the target portal crane and the target ship cabin to obtain the target 3D model, a first three-dimensional coordinate corresponding to the position in the target 3D model is generated based on the preset three-dimensional coordinate system, the first three-dimensional coordinate is processed, the data processing system executes the computer program to control the grab bucket to take the required data, the calculation is simple and convenient, the accuracy of the obtained data is high, and the operation efficiency of the system is improved.
Specifically, S1 includes the substeps of obtaining D z :
S11, obtaining E= { E 1 ,E 2 ,……,E j ,……,E n E is a second three-dimensional coordinate list corresponding to the target model area, E j For the j-th second three-dimensional coordinate corresponding to the target model area, j has a value of 1 to n, n is the number of the second three-dimensional coordinates, E j =(E x j ,E y j ,E z j ),E x j For E j Coordinate value on X-axis, E y j For E j Coordinate value on Y axis, E z j For E j The coordinate value on the Z axis of the target model region is a region corresponding to the working region of the target grab bucket in the target 3D model, and the second three-dimensional coordinate list corresponding to the target model region is all the first three-dimensional coordinates included in the target model region, so that a person skilled in the art knows that the person skilled in the art can determine the working region of the target grab bucket according to the reference of the target portal crane, and the details are not repeated here; for example: and determining the working area of the target grab bucket according to the specification of the target portal crane.
S12 according to E j Acquisition of D z Wherein D is z Meets the following conditions:
D z =Σ n j=1 (E z j /((F x -E x j ) 2 +(F y -E y j ) 2 ))/Σ n j=1 (1/((F x -E x j ) 2 +(F y -E y j ) 2 )),F x f, for the coordinate value on the X axis in the first three-dimensional coordinate corresponding to the preset material taking position in the target 3D model y And the coordinate value on the Y axis in the first three-dimensional coordinate corresponding to the preset material taking position in the target 3D model is obtained.
Through the steps, all the first three-dimensional coordinates of the working area of the target grab bucket in the corresponding area in the target 3D model are obtained and used as a second three-dimensional coordinate list, and the second height value corresponding to the preset material taking position is obtained according to the coordinate values, the ordinate and the vertical coordinates on the X axis in all the second three-dimensional coordinates in the second three-dimensional coordinate list and the coordinate values and the ordinate on the X axis in the first three-dimensional coordinates corresponding to the preset material taking position, so that the height difference between the material taking position and the bottom center position of the target grab bucket is corrected, and the interference of the local high points of the working area of the target grab bucket to the height difference between the material taking position and the bottom center position of the target grab bucket can be prevented.
S2, enabling the controller to send out a first instruction, wherein the first instruction is used for controlling the target grab bucket to accelerate and descend by the height B according to a first preset acceleration.
Specifically, the controller is in communication connection with the target gantry crane.
S3, enabling the controller to send out a second instruction, wherein the second instruction is used for controlling the target grab bucket, enabling the target grab bucket to accelerate and descend according to a second preset acceleration and receiving the torque output by the target torque sensor in real time, the target torque sensor is arranged on the target portal crane and used for detecting the torque applied to the target grab bucket, the torque is the vector product between the force action point and the force direction vector, the specific position of the target torque sensor in the target portal crane can be determined according to actual requirements by a person skilled in the art, and the detailed description is omitted.
Specifically, the first preset acceleration is greater than the second preset acceleration, where those skilled in the art know that the first preset acceleration and the second preset acceleration are all accelerations preset by those skilled in the art according to actual requirements, and are not described herein again.
Specifically, the target torque sensor is communicatively coupled to the controller.
Through the steps, the target grab bucket is controlled to accelerate and descend according to the first preset acceleration to the height B, damage to the grab bucket caused by the grab bucket contacting the surface of the material at a higher speed is prevented, after the target grab bucket descends according to the first preset acceleration to the height B, the target grab bucket is controlled to descend according to the second preset acceleration to receive the moment output by the target moment sensor in real time, the target grab bucket contacts the surface of the material at a lower speed, whether the grab bucket contacts the surface of the material is determined through the moment output by the target moment sensor, when the moment received by the controller at the current time point is smaller than the preset moment and the moment output by the target moment sensor in the preset time period is smaller than the preset moment, the grab bucket contacts the surface of the material, at the moment, the target grab bucket is required to stop descending, the depth value S corresponding to the target grab bucket is calculated, the target grab bucket descends to the height S is controlled, the material with the preset material taking weight can be obtained when the target grab bucket is controlled, the material taking efficiency can be understood to be obtained, and the material taking efficiency of a material taking system can be prevented from being wasted.
S4, if the moment received by the controller at the current time point is smaller than G 0 And all the moments received by the controller in the preset time period are smaller than G 0 Enabling the controller to send out a third instruction, wherein the third instruction is used for controlling the target grab bucket to stop descending, and G 0 The preset moment is known to a person skilled in the art, the preset moment is a moment preset by the person skilled in the art according to actual demands, and the preset time is a time preset by the person skilled in the art according to actual demands, and is not described herein.
S5, acquiring S, wherein S is a depth value corresponding to the target grab bucket, and the depth value is a vertical height distance between a bottom center point of the target grab bucket and a preset material taking position when the target grab bucket takes materials, and S meets the following conditions:
S=K 1 +K 2 ×M+K 3 ×M 2 m is a preset material taking weight, which is known to those skilled in the art and is set by those skilled in the art according to actual requirements, and is not described herein;
K 1 、K 2 、K 3 meets the following conditions:
[K 1 ,K 2 ,K 3 ] T =(M1 T ×M1) -1 ×M1 T x SD, M1 is the first matrix, SD is the second matrix;
m1 meets the following conditions:
M0 e the weight of the material obtained when the material in the target ship cabin is fetched for the e-th time of the target grab before the current time point, wherein the value of e is 1 to f, and f is the number of times that the material in the target ship cabin is fetched by the target grab before the current time point;
SD meets the following conditions:
SD=[S0 1 ,S0 2 ,…,S0 e ,…,S0 f ] T ,S0 e and taking the material in the target ship cabin for the e-th time before the current time point by the target grab, wherein the vertical height distance between the center point of the bottom of the target grab and the material taking position is the same.
Specifically, the depth value is measured in centimeters.
S6, enabling the controller to send out a fourth instruction, wherein the fourth instruction is used for controlling the target grab bucket to take materials after the target grab bucket descends by the height S.
According to the invention, the data processing system can acquire the first height value B corresponding to the target grab bucket in the target portal crane, the target grab bucket is controlled by the controller to descend according to the first preset acceleration, the target grab bucket is controlled by the controller to descend according to the second preset acceleration and receive the moment output by the target moment sensor in real time, if the moment received by the controller at the current time point is smaller than the preset moment and all moments received by the controller in the preset time period are smaller than the preset moment, the controller is controlled by the controller to stop descending of the target grab bucket, the depth value S corresponding to the target grab bucket is acquired according to the vertical height distance between the center point of the bottom of the target grab bucket and the material taking position when the target grab bucket takes material in the cabin each time before the current time point, the depth value S corresponding to the target grab bucket is acquired, the vertical height distance between the center point of the bottom of the target grab bucket and the preset position when the target grab bucket takes material taking is acquired, the vertical height value S corresponding to the material taking position can be calculated, the material taking efficiency can be prevented from being wasted when the weight of the material taking cabin is acquired by the conventional material taking position when the weight sensor is lower than the bottom of the material taking position.
While certain specific embodiments of the invention have been described in detail by way of example, it will be appreciated by those skilled in the art that the above examples are for illustration only and are not intended to limit the scope of the invention. Those skilled in the art will also appreciate that many modifications may be made to the embodiments without departing from the scope and spirit of the invention.