The present invention relates to the technical field of automatic control of tower cranes, in particular to an automatic hoisting and transporting method for a tower crane.
Tower cranes are key mechanical equipment in construction work, and can be seen everywhere in building construction sites, which can effectively save manpower, reduce construction costs and improve construction efficiency. Due to the high position of a cab in a tower crane, the field of view of a tower crane operator is greatly limited. In addition, there are buildings and obstacles in the site, which often lead to blind hoisting and blocked hoisting. A driver can only work by experience in combination with instructions of surface personnel, such that it is very blind and difficult to operate, and there are certain potential safety hazards. Meanwhile, the tower crane driver is prone to fatigue after repeating work for a long time in the small high-altitude cab, resulting in a great impact on safe production in hoisting and transporting operation of the tower crane. In order to solve this problem, an existing technology provides assistance for the driver mainly by arranging a tower crane operation monitoring system and acquiring operating parameters and video images of the tower crane to reduce visual blind zones. Tower crane driving is greatly affected by human factors, so the problem of driver fatigue driving still exists. As a result, an unmanned tower crane is an important direction for the research and development of new tower cranes.
Path planning and collision avoidance need to be taken into account for the realization of unmanned driving of tower cranes. According to a control method and an intelligent system for an unmanned tower crane designed in an invention patent application CN110182696A, a transport trajectory is generated by acquiring a real-time map where the tower crane is located, and intelligent obstacle avoidance is performed by using a simultaneous localization and mapping (SLAM) algorithm, a perception algorithm and other methods to achieve automatic control of the tower crane, but there is no specific technical solutions for the realization of hoisting and transporting path planning. According to a two-dimensional code-based automatic control system and control method for a tower crane designed in an invention patent application CN110482409A, it is proposed to search for a hoisting and transporting path by using a rapidly exploring random tree (RRT) algorithm, which can rapidly obtain a feasible path from an initial node to an end node, but this path is not necessarily an optimal path. According to a machine vision-based navigation method for prefabricated building construction proposed in an invention patent application CN109610850A, an implementation mode for calculating a hoisting and transporting path by using an ant colony algorithm is proposed. At present, an anti-collision technology for a tower crane mainly includes a video monitoring technology and sensor monitoring. A current video monitoring technology is not targeted and is only used for live image recording of a tower crane, such that image data information is not fully utilized for analysis, and a tower crane operator cannot be directly guided in operation or automatic operation cannot be realized. In a sensor monitoring mode, due to the restriction on installation of sensors at some key parts of a boom and a pull rod of a tower crane, setting of monitoring nodes is limited, such that the sensor-based monitoring mode has limited monitoring capability, obtained information is only limited to some sensitive technical parameters, and more comprehensive and intuitive tower crane operation conditions cannot be obtained in time.
None of the above can achieve better automatic path planning, so those skilled in the art urgently need to find a new technical solution to solve the above problems.
In view of the technical problems in the prior art, the present invention provides an automatic hoisting and transporting method for a tower crane.
The present invention discloses an automatic hoisting and transporting method for a tower crane, the method including:
The automatic hoisting and transporting method for the tower crane in the present invention replaces a manned driving mode. It takes the three-dimensional grid model of the construction site as the basis for hoisting and transporting path planning, modifies the data structure, which greatly shortening the calculation time, and improving the efficiency of path planning; by generating the obstacle node set, the relevant nodes can be avoided during path planning, so as to eliminate the problem of visual blind zones in manned driving and ensure that the object does not collide with the obstacle during hoisting and transporting, guaranteeing safe operation of the tower crane; the aerial hoisting and transporting path is planned according to the preset path planning strategy and the coordinates of the initial node and the end node of the hoisting and transporting operation, such that the heavy object is transported with higher efficiency under the condition of no collision, and the time and effort are saved; and whether the tower crane may be overturned is predicted according to the preset overturning calculation strategy during transportation, so as to prevent dangerous events from happening.
In order to illustrate the embodiments of the present invention or the technical solutions in the prior art more clearly, the following briefly introduces the accompanying drawings that need to be used in the description of the embodiments or the prior art. Apparently, the accompanying drawings in the description below are merely some embodiments of the present invention. Those of ordinary skill in the art may also derive other accompanying drawings from these accompanying drawings without creative efforts.
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings of the present invention. Apparently, the described embodiments are merely a part, rather than all of the embodiments of the present invention. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts fall within the scope of protection of the present invention.
As shown in
Step S10: a three-dimensional grid model for a construction site is built, and a grid node set Φ0 is generated.
As shown in
Step S101: a plurality of video monitoring cameras are arranged around a building and the tower crane.
The video monitoring cameras in this embodiment are configured to acquire live images around the building and the tower crane. The number of the live images is not limited here. Preferably, it is the best implementation mode that may ensure that there is no shooting dead angle around the building and the tower crane.
Step S102: the video monitoring cameras are turned on when the tower crane retracts a hoist hook, the video monitoring cameras are controlled to continuously adjust the shooting angles and acquire the live images at the same time.
Step S103: the live images are preprocessed according to a preset image preprocessing strategy to generate preprocessed images.
An objective of the image preprocessing is to distinguish the objects from the background and reduce interference factors in subsequent steps. Main processing modes include image enhancement, increase in a contrast between the moving object and the background, image edge detection, etc. Features of the tower crane, a boom and the hoist hook are extracted to facilitate positioning of the moving object.
Step S104: the preprocessed images are evaluated according to a preset image effect evaluation strategy.
The preset image effect evaluation strategy may be set by those skilled in the art. For example, when an image with a chaotic background appears, it is not conducive to feature extraction, such that if the processing effect of the preprocessed images is unqualified, Step S105 is performed.
Step S105: angles of the video monitoring cameras are adjusted, lens magnifications and lens focal lengths are changed, and the live images are reacquired. Step S103 and Step S104 continue to be performed for preprocessing the live images and evaluating the preprocessed images.
If the processing effect of the preprocessed images is qualified, Step S106 is performed.
Step S106: the three-dimensional grid model for the construction site is built according to the preprocessed images, and elevations z0 of grid nodes (x0, y0) are extracted under a preset plane grid accuracy.
In this step, the three-dimensional grid model for the construction site is built, coordinates of the grid nodes are determined, and the grid node set Φ0 is correspondingly generated. Model building may be performed by model building methods such as oblique photography, three-dimensional laser scanning, etc. The plane grid accuracy is set by those skilled in the art. In view of the size of the overall model, it is more appropriate to set the plane grid accuracy to be 1 m.
A coordinate system is established in the three-dimensional grid model for the construction site. Since the boom of the tower crane rotates with the tower crane base as a center, the origin of the Cartesian coordinate of the construction site can be set to the tower crane base. In order to better reflect an actual working mode of the tower crane, the coordinate system with the center of the tower crane base as the origin in the three-dimensional grid model is transformed into a cylindrical coordinate system. If a coordinate of a node in the three-dimensional grid model is (x,y,z), then a coordinate thereof in the cylindrical coordinate system is (r,θ,h). The changes of the coordinate r, θ, h reflect amplitude change, rotation and hoisting motion of the tower crane, respectively. A transformational relationship between the coordinates is as follows:
When the three-dimensional grid model is built in a cylindrical coordinate, this embodiment
further includes: (1) with a central axis of a tower body of the tower crane as a longitudinal axis of the cylindrical coordinate, angular coordinates θ are equally divided into a parts by a set step length; (2) the angular coordinates θ of all nodes are transformed into integers between 0 and a−1; and (3) with the angular coordinates of the nodes as indexes of a first-level list, radius coordinates r and height coordinates h of the nodes are taken as a second-level list. Preferably, the angular coordinates θ are equally divided into 360 parts by the set step length of 1°, the angular coordinates θ of all the nodes are transformed into the integers between 0 and 359, and then with the angular coordinates as the indexes of the first-level list, the radius coordinates r and height coordinates h of the nodes are stored in the second-level list. Namely:
Step S107: the three-dimensional grid model for the construction site is updated at a fixed frequency.
After the three-dimensional grid model for the construction site is built, the model is always updated at the fixed frequency when subsequent steps are performed.
The three-dimensional grid model is built by the above method, and then the grid node set Φ0 is generated in the following way:
A preset allowable amplitude change range [rmin,rmax], allowable rotation range [θmin,θmax], and allowable hoisting range [hmin,hmax] of the tower crane are obtained. An operator may preset the allowable amplitude change range [rmin,rmax], the allowable rotation range [θmin,θmax], and the allowable hoisting range [hmin,hmax] of the tower crane according to a structure of the tower crane.
m n P equal division is performed on the allowable amplitude change range [rmin,rmax], the allowable rotation range [θmin,θmax], and the allowable hoisting range [hmin,hmax] of the tower crane, respectively.
The grid node set Φ0 of nodes (r,θ,h) is generated as follows:
where when m n P equal division is respectively performed on the allowable amplitude change range [rmin,rmax], the allowable rotation range [θmin,θmax], and the allowable hoisting range [hmin,hmax] of the tower crane, n, P need to meet the following conditions:
In other words, it is required that the accuracy after grid division is not less than a smaller value between 1 m and a maximum distance lm, where lm is the maximum distance between the edge of the object (or the hoist hook) and its centroid coordinate, suppose the centroid coordinate of the hoisted and transported object is (xm,ym,zm), and the maximum distance between the edge of the hoisted and transported object and the centroid coordinate (xm,ym,zm) is lm.
If implementation is on the basis of the angular coordinates of the nodes as the indexes of the first-level list in the above embodiment, then a value of n in this embodiment is 360, and the allowable rotation range [θmin,θmax] is [0,359].
Step S20: an obstacle node set U0 and a feasible area node set Φ1 are generated according to the positions of the obstacles in the construction site and the grid node set Φ0.
In order to ensure that the object hoisted by the tower crane during hoisting do not collide with the obstacle in the construction site, it is necessary to determine the obstacle node set U0 according to the grid node set Φ0 and the position, size and shape of the obstacle in the construction site, and then obstacle nodes present in the grid node set Φ0 are removed to obtain the feasible area node set Φ1 where the hoist hook and the heavy object may move freely. The feasible area node set Φ1 is as follows:
where (ru,θu,hu) is a coordinate of the obstacle, U0 is the obstacle node set, and lextra is a set amount of redundancy. The amount of redundancy lextra refers to that the operator sets a value for ensuring safety according to the law of tower crane operation, and its specific value is not limited here.
Step S30: coordinates of the initial node S and the end node G of a hoisting and transporting operation are obtained by means of the three-dimensional grid model.
In the Cartesian coordinate system:
The coordinate of the center of the tower crane base in the Cartesian coordinate system is set to be (α0,b0,c0).
The coordinates of the initial point S and the end point G in the Cartesian coordinate system are obtained, and are respectively (αs,bs,cs) and (αg,bg,cg)
The coordinates of the initial point S and the end point G in the Cartesian coordinate system are transformed into coordinates in the three-dimensional grid model, which are respectively an initial point S(xs,ys,zs) and an end point G(xg,yg,zg), where
Size information of the hoisted and transported object is obtained, and the centroid coordinate (xm,ym,zm) of the hoisted and transported object and the maximum distance lm between the edge of the hoisted and transported object and the centroid coordinate (xm,ym,zm) are determined, or in the absence of the hoisted and transported object, a centroid coordinate of the hoist hook and a maximum distance between an edge of the hoist hook and the centroid coordinate are determined.
Alternatively, the coordinate (rs,θs,hs) of the initial point S and the coordinate (rG,θG,hG) of the end point G are correspondingly obtained in a mode of transformation between the Cartesian coordinate system and the cylindrical coordinate system in the foregoing embodiment.
Step S40: a hoisting and transporting path from the initial node S to the end node G is planned according to the initial node S, the end node G, the feasible area node set Φ1 and a preset hoisting and transporting path planning strategy, and corresponding operating parameters are generated.
Specifically, in an embodiment of the present invention, the hoisting and transporting path planning strategy includes:
The feasible area node set Φ1 is searched for nodes closest to the initial node S(xs,ys,zs) and the end node G(xg,yg,zg), where the nodes are respectively (rs,θs,hs) and (rg,θg,hg).
An area near the initial node S and the end node G is an operational area with high density of personnel, machines and tools, and obstacles, and the surrounding environment is constantly changing dynamically, such that when the heavy object is hoisted, it is not suitable to move horizontally in the area near the initial node S and the end node G. During hoisting and transporting, in this embodiment, the heavy object is vertically ascended to a certain height from the initial node S to reach a node
The safety height may be set by means of a constant method or a ratio method. The constant method is to manually determine a constant value hsafe of the safety height according to an actual situation of the site; and the ratio method is to determine a safety ratio λsafe and divide a space above the initial node or the end node according to the ratio. By taking the initial node S(rs,θs,hs) as an example, a coordinate of the aerial initial node
(1) the constant method:
and
(2) the ratio method:
where ┌ . . . ┐ is a round-up operator.
In addition, the preset safety height value is obtained, where the safety height value includes an ascent height value and a descent height value, the ascent height value and the descent height value are respectively
A reachable node set open list and an unconcerned node set close list are established. The former represents a set of reachable nodes to be checked, and the latter represents a set of nodes that no longer need to be concerned about.
The aerial initial node
The aerial initial node
Cost values f(n)=g(n)+h(n) of all nodes in the reachable node set open list are calculated, where g(n) represents an actual cost from the aerial initial node
The previous step is repeated, until the aerial end node
Starting from the aerial end node
The hoisting and transporting path is from the initial node S, the aerial initial node
Specifically, in another embodiment of the present invention, as shown in
S201: a reachable node set open list and an unconcerned node set close list are established.
The reachable node set open list and the unconcerned node set close list are established by the foregoing embodiment.
S202: the initial node S is put into the reachable node set open list, a total cost f(S) and an actual cost g(S) of the initial node S are set to be 0, and a parent node thereof is set as itself.
S203: in the reachable node set open list, a node n with a minimum total cost f(n) is selected, and the node n is deleted from the reachable node set open list, where a coordinate of the node n is (rn,θn,hn), the total cost of the node n is f(n)=g(n)+h(n) g(n) is the actual cost of the node n, h(n) is a heuristic function of the node n, h(n)=k1(hmid−hn)+k2+k3(|rn−rG|+|θn−θG|)+k4|hn−hG|, k1,k2, k3, k4 are preset weight functions, and hmid is a preset safety height value that needs to be ensured before wide-range horizontal motion.
Specifically, in this embodiment, a weight function k1 is mainly used to control the path to move up first to a target height hmid during hoisting. An expression of the weight function k1 is as follows:
where d(n,S) represents a Euclidean distance between the node n and the initial node S, d(n,G) represents a Euclidean distance between the node n and the end node G, and ρ is a preset radius range.
A weight function k2 in this embodiment is mainly used to increase costs of nodes near the initial node and below the target height hmid as a whole, so as to ensure smooth search for nodes outside the area after hoisting to the target height. When λ is set to be a constant at least an order of magnitude larger than d(S,G) then an expression of the weight function k2 is as follows:
where d(S,G) represents a Euclidean distance between the initial node S and the end node G.
In this embodiment, a weight function k3 is mainly used to control horizontal motion to the end node G. An expression of the weight function k3 is as follows:
In this embodiment, a weight function k4 is mainly used to control vertical motion to the end node G. A value of the weight function k4 may be a constant of 1.
The safety height hmid is comprehensively determined according to the height of the initial node S and the end node G and an allowable maximum ascent height hmax of the tower crane.
The safety height value is hmid=max(hS,hG)+(hmax−max(hS,hG))/2.
S204: a node m adjacent to the node n is obtained, and whether the node m belongs to the obstacle node set U0 or the unconcerned node set close list is determined, where a coordinate of the node m is (rm,θm,hm).
In this step, whether the node M belongs to the obstacle node set or the unconcerned node set close list is determined by comparing a coordinate (rm,θm,hm) of the node m with coordinates of nodes in the obstacle node set U0 and the unconcerned node set close list one by one. When the obstacle node set U0 and the unconcerned node set close list are relatively large, the number of comparisons will be greatly increased, such that the comparison process is slowed down to reduce the efficiency of path planning. Especially for the obstacle node set U0, due to the large work site of the tower crane, in order to ensure the path accuracy of the tower crane, the site is divided into space grids with a side length of each unit not greater than 1 m according to the previous steps, such that there are at least hundreds of thousands of obstacle nodes, resulting in a large number of comparisons.
For this, the embodiment of the present invention adopts a form of the foregoing nested list, including: the first-level list in the obstacle node set or the unconcerned node set close list is indexed with the angular coordinate θm of the node m to find the corresponding second-level list; and the corresponding second-level list is searched for the corresponding (rm,hm). When whether the node m belongs to the obstacle node set U0 or the unconcerned node set close list is queried, it is only necessary to query whether the θm-th second list has a corresponding coordinate (rm, hm) with its angular coordinate θm as an index. By means of the above method, most of elements in the list may be directly excluded during comparison to greatly reduce the number of times of determination. Similarly, the radius coordinates r or the height coordinates h may also be used as the indexes, but in a work scenario of the tower crane, the angular coordinates θ can often contain more integers, so it is more recommended to use the angles as the indexes.
If the node m does not belong to the obstacle node set U0 or the unconcerned node set close list, S205 is performed.
S205: whether the node m is already in the reachable node set open list.
S206: if the node m is not in the reachable node set open list, the node m is added to the reachable node set open list, the node n is set as a parent node of the node m, and a total cost f(m)=g(m)+h(m) of the node m is calculated, where g(m) represents an actual cost of moving from the initial node S to the node m via the parent node n thereof, g(m)=g(n)+|rm−rn·|+rn·|θm−θn|+hm−hn|, h(m) is a heuristic function of the node m, and h(m)=k1(hmid−hm)+k2+k3(|rm−rG|+θm−θG|)+k4|hm−hG|.
S207: if the node m is already in the reachable node set open list, a cost l(m,n)=g(n)+|rm−rn|+rn·|θm−θn|+|hm−hG| of reaching the node m from the initial node S via a non-parent node n is calculated, the cost l(m,n) is compared with the actual cost g(m), and if l(m,n)<g(m) the node n is set as the parent node of the node m, the actual cost is set to be g(m)−l(m,n), and the total cost f(m) is updated.
The node n has multiple adjacent nodes m, so S208 is performed after all the adjacent nodes m of the node n are traversed via S204 to S207.
S208: the node n is added to the unconcerned node set close list.
S203 to S208 are repeated, until the node selected from the reachable node set open list is the end node G.
S209: starting from the aerial end node G, backtracking is performed along the parent node of each of the nodes, and until the initial node S is reached, backtracked nodes are connected in sequence to obtain a hoisting and transporting path.
According to the present invention, the corresponding operating parameters are generated after the hoisting and transporting path from the initial node S to the end node G is planned by the above listed embodiment.
Step S50: the tower crane is controlled to transport the object according to the operating parameters, and a swing range of the hoisted and transported object and a swing arm at a current position is calculated according to a preset swing range calculation strategy.
Based on an optical flow algorithm, a velocity vector is assigned to each pixel point in the image to form a motion vector field. When there is the moving object in the image, the object and the background move relatively. The velocity vector formed by the moving object must be different from the velocity vector of the background. A corresponding relationship present between a previous frame and a current frame is found by means of changes of changing pixels in an image sequence in a time domain and a correlation between adjacent frames, thereby calculating out motion information of the object between the adjacent frames, and predicting a motion trend of the object.
According to this, the position of the object may be calculated and the moving object is tracked, where an instantaneous motion velocity of the object in a certain frame is v0, and an instantaneous motion velocity of the object in a next frame of image is v1. According to a live image acquisition frequency of the video monitoring camera, a time interval t of two frames of images is obtained, and a motion acceleration
of the heavy object may be obtained. The velocity and acceleration of the object when it falls to the ground may be estimated by means of these changes to avoid collision and impact. When the heavy object reaches a target landing position, in the direction of a motion trajectory of the object, an acceleration is a≤0, and a velocity is v=0, such that the object falls to the ground smoothly without collision. When the current position H is less than a safety distance
a motor is controlled to increase a pull force, until H≥S. In order to ensure the safety, a is controlled to be as small as possible, namely, H=S.
According to the three-dimensional grid model for the construction site, the tower crane, the swing arm, the hoist hook and the object are set as a space A, and the building and surrounding buildings are set as a space B. When A ∩B=Ø, the tower crane is free from collision.
The motion of the object is decomposed into sub-motions in three directions. The object horizontally moves up or down in a vertical direction under the pull force F1 of the tower crane. The object horizontally moves left or right under an action force F2 of a trolley. The boom of the tower crane rotates in a horizontal plane under an action force F3 of a rotation mechanism to drive the object to rotate on the horizontal plane. In linear motion, a resultant velocity and a resultant external force of the object must be kept parallel in direction, namely (G is the gravity of the object)
(F1−G):F2:F3=(x1−x0):(y1−y0):(z1−z0)
Thus, the motion of the object should satisfy the following conditions:
where K is the curvature of the motion trajectory, Δs is the length of the trajectory, and Δα is a tangential angle between the initial node and the end node.
According to the predicted motion trend of the object, the action forces of the motor in the three directions are dynamically adjusted, such that the motion trajectory tends to an optimal path.
Specifically, the calculating a swing range of the object and a swing arm at a current position according to a preset swing range calculation strategy, includes:
An operation mode of the tower crane is identified, where the operation mode includes a hoisting mode, an amplitude change mode, a rotation mode, a rotation and amplitude change mode, a hoisting and amplitude change mode, a hoisting and rotation mode and a hoisting, rotation and amplitude change mode.
Braking parameters are calculated according to the operation mode, where the braking parameters include braking time of the swing arm, a braking distance of the swing arm, a braking angle of the swing arm, a braking distance of the object, a swing amplitude of the object, the length of a cable, an angle between the cable and the vertical direction, braking time of the trolley, and a braking distance of the trolley.
After the tower crane starts to operate, the motion of the object is tracked according to the optical flow algorithm, and dynamic coordinates and motion changes of the tower crane and the object are obtained, where real-time operating parameters at least include the length l0 of the current cable, a velocity vc of the cable, a rotation angle θ0, an angular velocity ω of rotation, an amplitude r0 of the trolley, an amplitude change velocity vr of the trolley, a coordinate (r1,θ1,h1) of the hoisted and transported object, a velocity vr of the hoisted and transported object, the length rm of the swing arm, the height h0 of the swing arm, a hoisting load Fc, and average accelerations αc, α and αr during vertical locking, rotation locking and transverse locking, a node set Ut including grid coordinates (r1,θ1,h1) of an outer contour of the construction site, etc.
The swing range of the object and the swing arm is calculated according to the braking parameters.
(1) The process for calculating the braking parameters and the swing range in the hoisting mode, includes:
In the case of only hoisting, the swing arm and the trolley are both stationary, and the object only operates in the vertical direction, such that after locking in the vertical direction, the braking distance
of the object is calculated.
The swing range is W={(r1,θ1,h1)|h∈[h1, h1+Sm]}.
(2) The process for calculating the braking parameters and the swing range in the amplitude change mode, includes: In the case of only amplitude change, the swing arm and the cable are both stationary, the object only moves in a vertical plane where the swing arm is located. After transverse locking, the braking time
of the trolley is calculated, the braking distance of the trolley is
The amplitude of the trolley after braking is r0+Sc. If it is assumed that the object still moves at the original velocity after braking, then the coordinate of the object after braking is (r1+v1t,θ1,h1+l0(1−cos α1)) where α1 is an angle between the cable and the vertical direction after braking as follows:
After braking, the object starts to do a simple pendulum motion, and a velocity component of the object perpendicular to the cable is v1 cos α1. Due to energy conservation, the ascent height
of the object at a maximum swing amplitude is calculated, where g is an acceleration of gravity. An angle
between the cable and the vertical direction is calculated. The coordinate of the object at the maximum swing amplitude is (r0+Sc±l0 sin α2,θ1,h1+l0 (1-cos α2)). Thus, the swing range is W={(r1,θ1,h)|r∈[r0+Sc−l0 sin α2, r0+Sc+l0 sin α2],h∈[h1,h1+l0 (1−cos α2)]}.
(3) The process for calculating the braking parameters and the swing range in the swing mode, includes: in the case of rotation, the trolley and the cable are both stationary, and the cable pulls the object to move after the swing arm rotates. If rotation locking is performed, the braking time
and the braking distance
of the swing arm are calculated, the braking angle of the swing arm after braking is θ0+θd, and the swing range of the swing arm is W1={(r,θ,h0)|r∈(0,rm],θ∈(θ0,θ0+θd]}. If it is assumed that the object still moves at the original velocity after rotation braking, the coordinate (r1,θ1+ωt,h1) of the object after braking is calculated, and after braking, the object does a conical pendulum motion with the trolley as a fixed end at an angular velocity of
where φ1 is an angle between the cable and the vertical direction during the conical pendulum motion.
According to force balance of the object in the vertical and horizontal directions, an equation
is obtained. A value of φ1 is solved by means of the equation, where F is the pull force of the cable.
φ1 is
where λ is
and the swing range W2 of the object is a plane of h=h1 and a circle with (r0,θ0+θd,h1) as the center of circle and l0 sin φ1 as the radius, W2={(r,θ,h1)|r2−2rr0 cos(θ−θ0−θd)+r02=I02 sin2φ1}.
A total swing range is W=W1 ∪W2.
(4) The process for calculating the braking parameters and the swing range in the rotation and amplitude change mode, includes:
In the case of rotation and amplitude change, if rotation locking and amplitude change locking are performed at the same time, the coordinate
of the trolley after braking is calculated. The braking time
and the braking distance
of the swing arm are calculated, the braking angle of the swing arm is θ0+θd, and the swing range of the swing arm is W1={(r,θ,h0)|r∈(0,rm](θ0,θ0+θd]}. After braking, the object does the conical pendulum motion with the trolley as a fixed node, such that in order to improve the safety, v1 before braking is taken as the motion velocity of the object. According to the force balance of the object in the vertical and horizontal directions, the following equation may be obtained:
An angle φ1 between the cable and the vertical direction is calculated according to the equation.
where λ is
and the swing range W2 of the object is a plane of h=h1 and a circle with
as the center of circle and l0 sin φ1 as the radius, namely,
A total swing range is W=W1∪W2.
(5) The process for calculating the braking parameters and the swing range in the hoisting and amplitude change mode, includes:
In the case of hoisting and amplitude change, if vertical locking and transverse locking are achieved at the same time, the length
of the cable after braking is calculated.
The calculation method for the rest is similar to the amplitude change mode. If it is assumed that the object still moves forward at the original velocity when braking starts, the coordinate of the object after braking is as follows:
where α1 is an angle between the cable and the vertical direction after braking, and
After braking, the object starts to do the simple pendulum motion, and the velocity component of the object perpendicular to the cable is v1 cos α1. Due to energy conservation, the ascent height
of the object at the maximum swing amplitude is calculated, where g is the acceleration of gravity. The angle between the cable and the vertical direction is
The coordinate of the object at the maximum swing amplitude is (r0+Sc±l0′ sin α2,θ1,h1+l0′(1−cos α2)). Thus, the swing range is as follows:
W={(r,θ1,h)|r∈[r0+Sc−l0′ sin α2,r0+Sc+l0′ sin α2],h∈[h1,h1,l0′(1−cos α2)]}.
(6) The process for calculating the braking parameters and the swing range in the hoisting and rotation mode, includes:
In the case of hoisting and rotation, if vertical locking and transverse locking are achieved at the same time, the length
of the cable after braking is calculated. The remaining process is close to the rotation mode. The braking time
and the braking distance
of the swing arm are calculated, the braking angle of the swing arm is θ0+θd, and the swing range of the swing arm is W1={(r,θ,h0)|r∈(0,rm],θ∈(θ0,θ0+θd]}.
If it is assumed that the object still moves forward at the original velocity after braking, the coordinate of the object after braking is
The object does the conical pendulum motion with the trolley as the fixed end at the angular velocity of
where φ1 is the angle between the cable and the vertical direction during the conical pendulum motion.
According to the force balance of the object in the vertical and horizontal directions, the equation
is obtained. The value of φ1 is solved according to the equation, where F is the pull force of the cable. φ1 is
where λ is
and the swing range W2 of the object is a plane of
and a circle with
as the center of circle and l0′ sin φ as the radius, namely,
A total swing range is W=W1∪W2
(7) The process for calculating the braking parameters and the swing range in the hoisting, rotation and amplitude change mode, includes:
In the case where three motions of hoisting, rotation and amplitude change occur at the same time, the coordinate
of the trolley after braking is calculated; the length
of the cable after braking is calculated; and the braking time
and the braking distance
of the swing arm are calculated, the braking angle of the swing arm is θ0+θd, and the swing range of the swing arm is W1={(r,θ,h0)|r∈(0,rm],θ∈(θ0,θ0+θd]}. After braking, the object does the conical pendulum motion with the trolley as the fixed node, such that in order to improve the safety, v1 before braking is taken as the motion velocity of the object. According to the force balance of the object in the vertical and horizontal directions, the following equation may be obtained:
An angle φ1 between the cable and the vertical direction is calculated according to the equation.
wherein λ is
and the swing range W2 of the object is a plane of
and a circle with
as the center of circle and l0′ sin φ as the radius, namely,
A total swing range is W=W1∪W2.
Step S60: whether a collision may occur is determined according to the swing range and the obstacle node set U0
It includes: a determination condition is set as Ws∩Ut≠Ø, where Ws is an updated swing range after a safety margin is added to the swing range W,
Ws{(r,θ,h)|(r cos θ−ri cos θi)2+(r sin θ−ri sin θi)2+(h−hi)2≤rs2,(ri,θi,hi)∈W}, and
Ut is a node set including grid coordinates (rt,θt,ht) of an outer contour of the construction site.
If an intersection set of the node set Ut and the swing range Ws is a null set, it is considered safe, otherwise it is considered that the collision may occur.
Step S70: if not, the tower crane is controlled to continue to transport the object according to the hoisting and transporting path.
During transporting, Steps S50 and S60 continue to be performed always at a set frequency, and until the tower crane transports the object to a coordinate of a predetermined node, the object has a speed of v=0 and an acceleration of α≤0
Step S80: if yes, the tower crane is controlled to be braked.
According to the operation mode such as the hoisting mode, the amplitude change mode, the rotation mode, the rotation and amplitude change mode, the hoisting and amplitude change mode, the hoisting and rotation mode and the hoisting, rotation and amplitude change mode, vertical locking, transverse locking and rotation locking are correspondingly performed to brake the tower crane.
Step S90: whether the tower crane may be overturned is predicted according to a preset overturning calculation strategy during braking of the tower crane.
Specifically, the overturning calculation strategy includes:
when a vertical maximum braking acceleration during braking is set to be
and when a maximum moment of the tower crane is Mmax, an overturning determination condition is λ
The automatic hoisting and transporting method for the tower crane in the present invention replaces a manned driving mode, and plans the hoisting and transporting path on the basis of the three-dimensional grid model for the construction site, thereby optimizing an aggregate data structure, greatly shortening the calculation time, and improving the efficiency of path planning; by generating the obstacle node set, the problem of visual blind zones in manned driving is avoided, and relevant nodes can be avoided during path planning, so as to ensure that the object does not collide with the obstacle during hoisting and transporting to guarantee safe operation of the tower crane; the aerial hoisting and transporting path is planned according to the preset path planning strategy and the coordinates of the initial node and the end node of hoisting and transporting operation, such that the heavy object is transported with higher efficiency under the condition of no collision, and the time and effort are saved; and whether the tower crane may be overturned is predicted according to the preset overturning calculation strategy during transportation, so as to prevent dangerous events from happening.
The present invention is further described above with the help of specific embodiments, but it should be understood that the specific description here should not be construed as a limitation to the spirit and scope of the present invention. Various modifications made to the above-mentioned embodiments by those of ordinary skill in the art upon reading this specification fall within the scope of protection of the present invention.
Number | Date | Country | Kind |
---|---|---|---|
202011615448.6 | Dec 2020 | CN | national |
202110727448.3 | Jun 2021 | CN | national |
202111190913.0 | Oct 2021 | CN | national |
Filing Document | Filing Date | Country | Kind |
---|---|---|---|
PCT/CN2021/138684 | 12/16/2021 | WO |