Disclosure of Invention
The present invention aims to solve at least to some extent one of the technical problems existing in the prior art.
Therefore, an object of an embodiment of the present invention is to provide a climbing construction waste sorting robot system, which can improve the recycling rate of construction resources and reduce the environmental pollution caused by construction waste; and the applied image recognition function reduces the calculated amount and the memory space of data processing, and the robot can adapt to different terrains in operation, thereby improving the flexibility and the practicability.
Another object of the embodiments of the present invention is to provide a method for controlling a climbing construction waste sorting robot.
In order to achieve the technical purpose, the technical scheme adopted by the embodiment of the invention comprises the following steps:
in a first aspect, an embodiment of the present invention provides a climbing building waste sorting robot system, including:
the roller type moving module is used for driving the climbing construction waste sorting robot to move on the flat ground and the ramp;
the four-degree-of-freedom claw-type mechanical arm is used for picking up construction waste and putting the construction waste into a classification storage box;
the image detection module is used for acquiring image data of the construction waste, and detecting the position information of the construction waste, the category information of the construction waste and the motion information of the climbing construction waste sorting robot based on the image data;
the classified storage box is used for storing and containing the picked construction wastes;
and the control module is used for controlling the roller type moving module according to the position information of the construction waste and the motion information of the climbing construction waste sorting robot, and controlling the four-degree-of-freedom claw type mechanical arm according to the category information of the construction waste.
The embodiment of the invention provides a climbing construction waste sorting robot system, wherein a climbing construction waste sorting robot body acquires image data of construction waste on a construction site, analyzes and processes the image data through an image detection module, and further identifies the position and the category of the construction waste, so that a four-degree-of-freedom claw-shaped mechanical arm is controlled to pick up and classify the construction waste. Therefore, the climbing construction waste sorting robot system can improve the recycling rate of construction resources, reduce the pollution of construction waste to the environment and has good ecological benefit. Meanwhile, the embodiment of the invention also obtains the motion information of the climbing construction waste sorting robot through the image detection module, and controls the rotating speed of the motor in the roller type moving module based on the motion state of the climbing construction waste sorting robot, so that the climbing construction waste sorting robot can not only travel on the flat ground, but also climb, and the flexibility and the practicability of the climbing construction waste sorting robot for sorting the construction waste are improved.
In addition, the climbing construction waste sorting robot system according to the above embodiment of the present invention may further have the following additional technical features:
further, in one embodiment of the present invention, the roller type moving module includes:
the chassis support is used for bearing the four-degree-of-freedom claw-shaped mechanical arm, the image detection module, the classification storage box and the control module;
the omnidirectional wheel is arranged below the chassis support and used for realizing the movement of the climbing construction waste sorting robot on the flat ground and the ramp;
and the motor is used for receiving a control instruction of the control module and driving the omnidirectional wheel to move.
In a second aspect, an embodiment of the present invention provides a method for controlling a climbing building waste sorting robot, including the following steps:
collecting image data of construction waste;
determining position information of the construction waste and motion information of a climbing construction waste sorting robot based on the image data;
planning a path from the climbing construction waste sorting robot to the construction waste according to the position information of the construction waste to obtain path information;
determining a speed change signal according to the motion information of the climbing construction waste sorting robot;
and controlling the climbing construction waste sorting robot to operate according to the path information and the speed change signal.
By adopting the technical scheme, the climbing construction waste sorting robot can automatically plan moving path data based on the position of construction waste, reduce the repetition rate of the moving path of the climbing construction waste sorting robot, enlarge the path coverage rate in the process of picking up construction waste and improve the working efficiency of the climbing construction waste sorting robot; the speed change signal is determined through the motion information of the climbing construction waste sorting robot, so that the climbing construction waste sorting robot can correspondingly adjust the running speed of the motor according to different terrain conditions, and the climbing construction waste sorting robot is better suitable for flat ground and slopes of a construction site.
In addition, the climbing construction waste sorting robot system according to the above embodiment of the present invention may further have the following additional technical features:
further, in an embodiment of the present invention, the step of determining the motion information of the climbing construction waste sorting robot specifically includes:
extracting characteristic points in the image data by a principal component analysis method;
and determining the displacement of the characteristic points in the two adjacent frames of image data, and taking the displacement as the motion information of the climbing construction waste sorting robot.
Further, in an embodiment of the present invention, the step of determining a speed change signal according to the movement information of the climbing construction waste sorting robot specifically includes:
based on the motion information, a PWM control signal is generated as a speed change signal by a PID regulator.
Further, in one embodiment of the present invention, the method further comprises the steps of:
determining category information of the construction waste based on the image data;
and controlling the climbing construction waste sorting robot to classify and place the construction waste according to the category information.
By adopting the technical scheme, the climbing construction waste sorting robot acquires the image data of the construction waste on the construction site, and identifies the category of the construction waste based on the image data, so that the mechanical arm is controlled to classify the construction waste, and the efficiency of resource recycling is improved.
Further, in an embodiment of the present invention, the step of determining the category information of the construction waste based on the image data specifically includes:
acquiring a pre-established matching template set, wherein each matching template in the matching template set carries a category label;
determining a difference index value of each matching template and the image data gray value;
and taking the category label carried by the matching template with the minimum difference index value as the category information of the construction waste.
Further, in one embodiment of the present invention, the method further comprises the steps of:
and optimizing and updating each matching template in the matching template set through a genetic algorithm.
In a third aspect, an embodiment of the present invention provides a control device for a climbing construction waste sorting robot, including:
at least one processor;
at least one memory for storing at least one program;
when the at least one program is executed by the at least one processor, the at least one program causes the at least one processor to implement the climbing construction waste sorting robot control method.
In a fourth aspect, the embodiment of the present invention further provides a storage medium, in which processor-executable instructions are stored, and when the processor-executable instructions are executed by a processor, the processor-executable instructions are used for implementing the climbing construction waste sorting robot control method.
Advantages and benefits of the present invention will be set forth in part in the description which follows and, in part, will be obvious from the description, or may be learned by practice of the invention:
the embodiment of the invention comprises a climbing construction waste sorting robot system and a control method thereof, and the climbing construction waste sorting robot can improve the recovery utilization rate of construction resources, reduce the pollution of construction waste to the environment and has strong practical significance; moreover, the image recognition function of the climbing construction waste sorting robot is optimized and improved, the calculated amount and the storage amount of image data processing are reduced, and an accurate image recognition result can be obtained; can guarantee that the robot can not only go on the level land, can also climb, improve the flexibility and the practicality of robot letter sorting building discarded object.
Detailed Description
Reference will now be made in detail to embodiments of the present invention, examples of which are illustrated in the accompanying drawings, wherein like or similar reference numerals refer to the same or similar elements or elements having the same or similar function throughout. The embodiments described below with reference to the accompanying drawings are illustrative only for the purpose of explaining the present invention, and are not to be construed as limiting the present invention. The step numbers in the following embodiments are provided only for convenience of illustration, the order between the steps is not limited at all, and the execution order of each step in the embodiments can be adapted according to the understanding of those skilled in the art.
Hereinafter, a climbing construction waste sorting robot system and a control method thereof according to an embodiment of the present invention will be described in detail with reference to the accompanying drawings, and first, a climbing construction waste sorting robot system according to an embodiment of the present invention will be described with reference to the accompanying drawings.
Referring to fig. 1, the climbing construction waste sorting robot system according to the embodiment of the present invention mainly includes:
the rollertype moving module 101 is used for driving the climbing construction waste sorting robot to move on the flat ground and the ramp;
the four-degree-of-freedom claw-typemechanical arm 102 is used for picking up construction waste and throwing the construction waste into theclassification storage box 104;
theimage detection module 103 is used for acquiring image data of the construction waste, and detecting and obtaining position information of the construction waste, category information of the construction waste and motion information of the climbing construction waste sorting robot based on the image data;
a sortingstorage box 104 for storing the picked construction waste;
and thecontrol module 105 is used for controlling the rollertype moving module 101 according to the position information of the construction waste and the motion information of the climbing construction waste sorting robot, and controlling the four-degree-of-freedom claw typemechanical arm 102 according to the type information of the construction waste.
Further as a preferred embodiment, the rollertype moving module 101 includes:
a chassis support 1011 for carrying the four-degree-of-freedom claw robot 102, theimage detection module 103, theclassification storage box 104 and thecontrol module 105;
the omnidirectional wheel 1012 is arranged below the chassis support 1011 and used for realizing the movement of the climbing construction waste sorting robot on the flat ground and the ramp;
and the motor 1013 is configured to receive a control instruction from thecontrol module 105 and drive the omnidirectional wheel 1012 to move.
In the embodiment of the invention, the climbing construction waste sorting robot system comprises a rollertype moving module 101, a four-degree-of-freedom claw-shapedmechanical arm 102, animage detection module 103, aclassification storage box 104 and acontrol module 105. The roller-type moving module 101 mainly includes a plurality of chassis brackets 1011, and the number of the chassis brackets 1011 may be plural. At least one omnidirectional wheel 1012, a four-degree-of-freedom claw-typemechanical arm 102, animage detection module 103, aclassification storage box 104 and acontrol module 105 are fixed on each chassis support 1011, and the omnidirectional wheels 1012 are connected with a motor 1013 for driving, so that the movement on the flat ground and the slope can be realized and obstacles can be avoided. The four-degree-of-freedom claw-shapedmechanical arm 102 is used for picking up construction waste on a construction site; theimage detection module 103 may include an industrial camera or a near infrared hyperspectral camera, and may acquire original image data of a construction site, identify image data of construction waste therein, perform noise reduction preprocessing on the image data, and then analyze the image data to obtain position information of the construction waste, category information of the construction waste, and motion information of the climbing construction waste sorting robot. Thesorting bin 104 is used for storing construction waste picked up by the four-degree-of-freedom claw robot 102. Thecontrol module 105 is configured to plan a motion path of the robot according to the position information of the construction waste, control the rollertype moving module 101 to perform a function of walking on a flat ground or climbing on a slope based on the motion information of the climbing construction waste sorting robot, and control the four-degree-of-freedom claw typemechanical arm 102 to place the construction waste into a corresponding position in the sortingstorage box 104 according to the category information of the construction waste. It should be understood that the construction waste in the embodiment of the present invention refers to waste generated at the construction site of a new or demolished construction project, and includes, but is not limited to, any one or more recyclable resources such as slag, concrete blocks, crushed stone, brick and tile fragments, waste mortar, slurry, asphalt blocks, waste plastics, waste metals, waste bamboo and wood. In the embodiment of the present invention, the category information of the construction waste refers to the category of each construction waste, and may be classified according to the material or the actual action thereof, for example, into different categories such as foam, brick, plastic, concrete, wood, and the like.
The following describes in detail a climbing construction waste sorting robot control method according to an embodiment of the present invention with reference to the accompanying drawings.
Referring to fig. 2, the method for controlling a climbing construction waste sorting robot in the embodiment of the present invention mainly includes the following steps:
s1: collecting image data of construction waste;
s2: determining position information of the construction waste and motion information of a climbing construction waste sorting robot based on the image data;
s3: planning a path from the climbing construction waste sorting robot to the construction waste according to the position information of the construction waste to obtain path information;
in the embodiment of the invention, based on the path information, the climbing construction waste sorting robot can move to the dumping area of the construction waste, and a four-degree-of-freedom claw-shaped mechanical arm is used for performing operations such as rotation, clamping, picking and the like, so as to pick up the construction waste on site. The embodiment of the invention can effectively improve the efficiency and safety of the construction waste recovery, is beneficial to resource recovery and environmental protection, simultaneously reduces the possible safety risk of manually sorting the construction waste in a construction site, and saves the cost.
S4: determining a speed change signal according to the motion information of the climbing construction waste sorting robot;
further, as a preferred embodiment, the step of determining the motion information of the climbing construction waste sorting robot specifically includes:
s21: extracting characteristic points in the image data by a principal component analysis method;
s22: and determining the displacement of the characteristic points in the two adjacent frames of image data, and taking the displacement as the motion information of the climbing construction waste sorting robot.
Further, in a preferred embodiment, the step of determining a speed change signal according to the motion information of the climbing construction waste sorting robot includes:
based on the motion information, a PWM control signal is generated as a speed change signal by a PID regulator.
In an embodiment of the present invention, the step of extracting feature points in the image data by a principal component analysis method specifically includes:
s211: the image data D (x, y) (image pixel quantity W × H, 1 ≦ x ≦ W, 1 ≦ y ≦ H) is expressed as n column vectors of p dimensions, i.e., D ═ χ ≦ H1,χ2,…,χn}p×n;
S212: the image data D is then centered using the formula
Obtaining centralized image data, and marking the image data as X;
s213: determining a covariance matrix
X is the image data after decentralization, and M is a symmetric matrix with dimension p multiplied by p;
s214: performing eigenvalue decomposition on the covariance matrix M to obtain an eigenvalue lambda1≥λ2≥…≥λpSelecting the eigenvectors corresponding to the first k eigenvalues to form a projection matrix beta1,β2,…βk],βiIs a p-dimensional vector;
s215: projecting the original sample image data D to a new feature space to obtain a new dimension-reduced sample, X ═ ATX and X' are p multiplied by n dimensional matrixes.
In the embodiment of the present invention, Principal Component Analysis (PCA) is used as a technique for simplifying a data set. The method is linear transformation, and the transformation transforms data into a new coordinate system, so that the speed of feature extraction can be effectively accelerated. Extracting representative characteristic points Z (x, y) based on the transformed image data, and determining the specific positions of the characteristic points Z (x, y) in the current frame image data; acquiring the last frame image data D
0(x
0,y
0) Characteristic point Z of
0(x
0,y
0) And its specific location; comparison of Z (x, y), Z
0(x
0,y
0) To obtain the position change information of the feature point Z relative to Z
0Amount of displacement of
The motion information of the climbing construction waste sorting robot can be obtained, if the displacement is very small, the climbing construction waste sorting robot is in a climbing state, the power is insufficient, and the rotating speed of the motor is required to be adjusted to possibly reach a normal level. In particular, based on the motion information, i.e. feature point Z relativeAt Z
0The displacement of the motor is adjusted by a PID adjusting method, the duty ratio of a PWM control signal of the motor is adjusted, and then a speed change signal is sent out to correspondingly adjust the rotating speed of the motor. The logical relationship can be expressed as:
wherein PWM refers to the duty ratio of the PWM control signal, k
pIs a proportionality coefficient, k
iIs an integral coefficient, k
dThe proportional coefficient, the integral coefficient and the differential coefficient in the PID regulator can be obtained by experience and can be flexibly adjusted according to requirements.
S5: and controlling the climbing construction waste sorting robot to operate according to the path information and the speed change signal.
In the embodiment of the invention, the climbing construction waste sorting robot can automatically plan moving path data based on the position of the construction waste, reduce the repetition rate of the moving path of the climbing construction waste sorting robot, enlarge the path coverage rate in the process of picking up the construction waste and improve the working efficiency of the climbing construction waste sorting robot; the speed change signal is determined through the motion information of the climbing construction waste sorting robot, so that the climbing construction waste sorting robot can correspondingly adjust the running speed of the motor according to different terrain conditions, and the climbing construction waste sorting robot is better suitable for flat ground and slopes of a construction site.
Further as a preferred embodiment, the method further comprises the steps of:
s6: determining category information of the construction waste based on the image data;
s7: and controlling the climbing construction waste sorting robot to classify and place the construction waste according to the category information.
In the embodiment of the invention, the climbing construction waste sorting robot acquires the image data of the construction waste on the construction site, and identifies the category of the construction waste based on the image data, so that the mechanical arm is controlled to classify the construction waste, and the resource recycling efficiency is improved.
Further preferably, the step of determining the category information of the construction waste based on the image data includes:
s61: acquiring a pre-established matching template set, wherein each matching template in the matching template set carries a category label;
s62: determining a difference index value of each matching template and the image data gray value;
s63: and taking the category label carried by the matching template with the minimum difference index value as the category information of the construction waste.
In the embodiment of the invention, a plurality of matching templates are preset, the matching templates comprise image data of various types of construction wastes, and each matching template carries a category label of the construction wastes contained in the matching template.
Specifically, let the image data size of the matching template be a × b (width × height), the actually acquired image data size of the construction waste be Α × beta (width × height), the coordinates of a certain pixel point on the matching template be (x, y), and its gray value be G (x, y); the coordinates of the pixel points in the construction waste image data superposed with the coordinates are (P-x, Q-y), and the gray value of the pixel points is F (P-x, Q-y); and then continuously determining the difference index value of each point gray value between the matching template and the image data, wherein the difference index value can be obtained through a formula
To measure. And matching the image data of the construction waste with all the matching templates, and selecting the category label carried by the matching template with the minimum difference index value as the category information of the construction waste.
Further as a preferred embodiment, the method further comprises the steps of:
s8: and optimizing and updating each matching template in the matching template set through a genetic algorithm.
In the embodiment of the present invention, the method for performing optimization update on each matching template in the matching template set by using a genetic algorithm specifically comprises:first, an initial matching template feature point Z is giveniStarting a genetic algorithm loop; program i ← 1, with ZiConstructing an initial population for an initial parent; programming j ← 1, for j generation initial population SjGenerating a new j +1 th generation population S by using a crossover operator, a mutation operator and a selection operatorj+1(ii) a Calculating adaptation values of all individuals in the population through a fitness function, searching the individual with the minimum adaptation value from all the individuals in the current population, recording the individual as R, and enabling an initial template Z to beiIf R, Z is satisfiedi-Zi-1If [ l ] is less than [ delta ] (where [ delta ] is a predetermined, relatively small positive number), then use ZiAnd (4) exiting the genetic algorithm for the optimal solution, and otherwise, returning to the cycle again. The crossover operator, the mutation operator, the selection operator and the fitness function in the embodiment of the invention can adopt any one of the conventional modes.
Referring to fig. 3, an embodiment of the present invention provides a control device for a climbing construction waste sorting robot, including:
at least oneprocessor 201;
at least onememory 202 for storing at least one program;
when the at least one program is executed by the at least oneprocessor 201, the at least oneprocessor 201 is caused to implement the climbing construction waste sorting robot control method.
Similarly, the contents of the method embodiments are all applicable to the apparatus embodiments, the functions specifically implemented by the apparatus embodiments are the same as the method embodiments, and the beneficial effects achieved by the apparatus embodiments are also the same as the beneficial effects achieved by the method embodiments.
The embodiment of the present invention also provides a storage medium, in which instructions executable by theprocessor 201 are stored, and the instructions executable by theprocessor 201 are used for executing the climbing construction waste sorting robot control method when executed by theprocessor 201.
Similarly, the contents in the foregoing method embodiments are all applicable to this storage medium embodiment, the functions specifically implemented by this storage medium embodiment are the same as those in the foregoing method embodiments, and the advantageous effects achieved by this storage medium embodiment are also the same as those achieved by the foregoing method embodiments.
In alternative embodiments, the functions/acts noted in the block diagrams may occur out of the order noted in the operational illustrations. For example, two blocks shown in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality/acts involved. Furthermore, the embodiments presented and described in the flow charts of the present invention are provided by way of example in order to provide a more thorough understanding of the technology. The disclosed methods are not limited to the operations and logic flows presented herein. Alternative embodiments are contemplated in which the order of various operations is changed and in which sub-operations described as part of larger operations are performed independently.
Furthermore, although the present invention is described in the context of functional modules, it should be understood that, unless otherwise stated to the contrary, one or more of the described functions and/or features may be integrated in a single physical device and/or software module, or one or more functions and/or features may be implemented in a separate physical device or software module. It will also be appreciated that a detailed discussion of the actual implementation of each module is not necessary for an understanding of the present invention. Rather, the actual implementation of the various functional modules in the apparatus disclosed herein will be understood within the ordinary skill of an engineer, given the nature, function, and internal relationship of the modules. Accordingly, those skilled in the art can, using ordinary skill, practice the invention as set forth in the claims without undue experimentation. It is also to be understood that the specific concepts disclosed are merely illustrative of and not intended to limit the scope of the invention, which is defined by the appended claims and their full scope of equivalents.
The functions, if implemented in the form of software functional units and sold or used as a stand-alone product, may be stored in a computer readable storage medium. Based on such understanding, the technical solution of the present invention may be embodied in the form of a software product, which is stored in a storage medium and includes instructions for causing a computer device (which may be a personal computer, a server, or a network device) to execute all or part of the steps of the method according to the embodiments of the present invention. And the aforementioned storage medium includes: a U-disk, a removable hard disk, a Read-Only Memory (ROM), a Random Access Memory (RAM), a magnetic disk or an optical disk, and other various media capable of storing program codes.
The logic and/or steps represented in the flowcharts or otherwise described herein, e.g., an ordered listing of executable instructions that can be considered to implement logical functions, can be embodied in any computer-readable medium for use by or in connection with an instruction execution system, apparatus, or device, such as a computer-based system, processor-containing system, or other system that can fetch the instructions from the instruction execution system, apparatus, or device and execute the instructions. For the purposes of this description, a "computer-readable medium" can be any means that can contain, store, communicate, propagate, or transport the program for use by or in connection with the instruction execution system, apparatus, or device.
More specific examples (a non-exhaustive list) of the computer-readable medium would include the following: an electrical connection (electronic device) having one or more wires, a portable computer diskette (magnetic device), a Random Access Memory (RAM), a read-only memory (ROM), an erasable programmable read-only memory (EPROM or flash memory), an optical fiber device, and a portable compact disc read-only memory (CDROM). Additionally, the computer-readable medium could even be paper or another suitable medium upon which the program is printed, as the program can be electronically captured, via for instance optical scanning of the paper or other medium, then compiled, interpreted or otherwise processed in a suitable manner if necessary, and then stored in a computer memory.
It should be understood that portions of the present invention may be implemented in hardware, software, firmware, or a combination thereof. In the above embodiments, the various steps or methods may be implemented in software or firmware stored in memory and executed by a suitable instruction execution system. For example, if implemented in hardware, as in another embodiment, any one or combination of the following techniques, which are known in the art, may be used: a discrete logic circuit having a logic gate circuit for implementing a logic function on a data signal, an application specific integrated circuit having an appropriate combinational logic gate circuit, a Programmable Gate Array (PGA), a Field Programmable Gate Array (FPGA), or the like.
In the foregoing description of the specification, reference to the description of "one embodiment/example," "another embodiment/example," or "certain embodiments/examples," etc., means that a particular feature, structure, material, or characteristic described in connection with the embodiment or example is included in at least one embodiment or example of the invention. In this specification, schematic representations of the above terms do not necessarily refer to the same embodiment or example. Furthermore, the particular features, structures, materials, or characteristics described may be combined in any suitable manner in any one or more embodiments or examples.
While embodiments of the present invention have been shown and described, it will be understood by those of ordinary skill in the art that: various changes, modifications, substitutions and alterations can be made to the embodiments without departing from the principles and spirit of the invention, the scope of which is defined by the claims and their equivalents.
While the preferred embodiments of the present invention have been illustrated and described, it will be understood by those skilled in the art that various changes in form and details may be made therein without departing from the spirit and scope of the invention as defined by the appended claims.