Background
Two-dimensional laser scanner
The two-dimensional laser photoelectric scanner performs laser scanning ranging on the surrounding environment on a scanning plane through an internal rotating mechanism, and the ranging mode is 'flight time measurement':
1. emitting a laser pulse of a circular light spot in the current measuring direction;
2. receiving laser pulses reflected from the surface of the measured object;
3. measuring the time from the emission to the receiving of the laser pulse, and obtaining the distance of a measured object on the current measurement direction angle through 'time-distance conversion';
4. the measuring direction angle is continuously changed on one plane (laser scanning plane) through the rotating mechanism, so that the measurement of the cross section outline of the surrounding environment on the plane is realized, the measurement data is given in a polar coordinate representation mode, and the measurement data can be further converted into a two-dimensional rectangular coordinate representation under the coordinate system of scanner equipment.
The two-dimensional laser scanner (hereinafter referred to as laser scanner) based on the technology can effectively work under all-weather conditions, acquire accurate distance and two-dimensional shape data, and is an important sensor for realizing automatic safety operation of large-scale mechanical equipment.
(II) working equipment and container yard layout
The basic application of the invention is that the container handling operation wharf of 20 feet/40 feet adopting a through type track portal crane is most common at present, and the operation elements are as follows:
1. and (3) a container: the metal box body is in a cuboid shape, and locking holes are formed in the upright posts at four corners of the upper bottom surface and the lower bottom surface and are used for hoisting and fixing on a flat plate. The container is provided with different 'box types', the box types related to the invention comprise 20 feet boxes, 40 feet boxes (common boxes and high boxes) and 45 feet boxes, the length, width and height of each box type are international standards, wherein the box widths are completely the same, and the length and the height are different;
2. gantry crane: the crane is of a frame structure and is operated by a driver, and the structural elements comprise:
1) And (3) a cart: the device consists of two sets of door legs and a pair of cross beams erected on the door legs, wherein wheel pairs are arranged on the door legs, and the device walks on the ground along the direction perpendicular to the cross beams during operation, and is called a large vehicle:
2) And (3) a trolley: the rail is paved on the beam, a wheel rail travelling mechanism is erected, and the wheel rail travelling mechanism can travel along the direction of the beam and is called a trolley;
3) Lifting appliance: the lifting appliance is hung on the trolley through a steel wire rope, lifting can be realized by winding and unwinding the steel wire rope, a main beam of the lifting appliance is provided with two pairs of telescopic horizontal lifting arms, two ends of the bottom surface of each lifting arm are provided with rotatable locking pins, the locking pins are inserted into locking holes of the container and can be fastened and connected with the container after rotating, and the lifting appliance can load and unload the container according to the requirement, so that the locking pins are aligned with the locking holes on the upper surface of the container, and lifting of the container is realized;
4) Cab: a cab is hung below the trolley, a crane driver operates the trolley and the trolley of the crane to walk in the cab facing the lifting appliance direction, and lifting of the lifting appliance, telescoping of a suspension arm and rotation of a lock pin are realized, so that the lifting operation of the container is realized;
3. and (3) a storage yard: the container stacking areas are orderly arranged according to rectangular grids, the row direction of the grids is the left-right direction, and the column direction is the front-back direction; stacking a group of container stacks with the same length and width and aligned up and down strictly in each grid; the containers in each row of grids are aligned along the left-right direction, and the container in each column of grids has the same length and is aligned along the front-back direction;
4. shellfish position: when the container lifting operation is executed, the cart is firstly aligned with the bin position where the operation box is located, and then the cart moves back and forth in the bin position, so that the lifting appliance reaches the target position of the operation box.
(III) workflow
The basic operation content of the operation mode is container exchange between a storage yard and a trailer, comprising boxing operation and unloading operation, and the typical flow is as follows:
1. boxing: the crane driver stretches the suspension arm according to the operation instruction and is matched with the length of the target box; the cart is operated to run to a specified shellfish position along the left-right direction, so that the lifting appliance is aligned with Bei Wei left and right; the operation trolley conveys the lifting appliance to the upper part of the target box group, so that the lifting appliance is aligned with the front and back of the target box; lowering the lifting appliance to grab the target box and locking the lifting appliance lock pin; operating the trolley to enable the lifting appliance to lift the target box to the position above the container trailer in the lane and to lower the target box to the trailer plate;
2. unloading: the crane driver operates the trolley to return to the position above the lane; the boom is stretched according to the operation instruction and matched with the box length of the target box; the cart is operated to run to the specified shellfish position, and the trailer reaches the lower part of the crane at the moment, and the flat plate of the cart is approximately aligned with the specified shellfish position; lowering the lifting appliance to grab the target box; lifting the lifting appliance; the operation trolley conveys the lifting appliance to the upper part of the target box group, so that the lifting appliance is aligned with the target box in front-back direction; lowering the lifting appliance to place the target box at the target phase; and operating the lifting appliance to unlock and lift the lifting appliance.
(IV) dangerous case and avoiding mode of operation
According to the loading and unloading operation flow, the main operation dangerous cases and the corresponding dangerous case avoiding modes of the container loading and unloading operation in the storage yard comprise:
1. horizontal bump box: when a trolley driver lifts a target box in a stacking yard shellfish position, the lifting height of a lifting appliance is insufficient, so that the target box collides with a box stack higher in the advancing direction; the corresponding dangerous case avoiding mode is that the trolley brakes;
2. vertical bump box: when a trolley driver lowers a target box above a target box in a storage yard shellfish position, the position of a lifting appliance is not aligned with the front and back of the target box, so that the bottom of the target box collides with the top of a higher box stack adjacent to the target box; the corresponding dangerous case avoiding mode is lifting appliance braking.
(sixth) application State
Aiming at the dangerous cases, some anti-collision box systems exist at present, a laser scanner is installed on a trolley, the box column outline in an operation shell position is scanned, the operation working conditions of the trolley and a lifting appliance are combined, the potential dangerous cases of the collision boxes are predicted, and a dangerous case avoiding instruction is sent to a control system of a crane.
Because the mounting position of the laser scanner on the trolley is limited by a plurality of structural conditions, and the mounting height is required to be higher than the highest lifting height of the lifting appliance, the lifting appliance and the operation box can form shielding on the scanning range of the scanner, meanwhile, the laser scanners mounted on any position of the trolley are likely to have higher box stacks shielding lower target box stacks due to different heights of the box stacks in the bin positions, and therefore complete box column profile information is difficult to acquire.
When the system is actually used, certain restrictions are required to be carried out on the operation mode of a trolley driver, for example, in the process of lifting a target box, in order to prevent the box from being horizontally bumped, the trolley driver is required to lift the target box to the highest height, then move the trolley to the position above a lane or the position above the target box, and then lower the target box, so that the operation efficiency is lower and the energy consumption is higher; meanwhile, due to the fact that adjacent box stacks are shielded, the problem that the height of the adjacent box stack on one side of the target box position is difficult to obtain all the time exists in a single laser scanner, and the occurrence of vertical collision of the box cannot be avoided, so that a trolley driver is required to switch into a speed-limiting descending mode when the target box is descended to a specific height, serious accidents caused by the fact that the box is vertically collided possibly happen are avoided, the operation efficiency is reduced, and the effectiveness of a protection system is insufficient.
Detailed Description
1. Working condition information and spatial data definition
In order to realize effective discovery of dangerous cases of horizontal and vertical collision of the working box in the lifting process of the working box, the system needs to acquire a series of working condition information and spatial data, comprehensively analyze and judge the working condition information and the spatial data according to the data, and control the crane operation based on the judging result.
In order to clearly describe such operating condition information and spatial data, the following definitions are specifically made.
1. Azimuth definition
The direction in the invention is defined according to the driving gesture of the crane driver, therefore, the traveling direction of the cart is the left/right direction, the traveling direction of the cart is the front/back direction, the lifting appliance is positioned in front of the driver, and the moving direction is the up/down direction.
2. Cart coordinate System and related definition
The scale, position, direction, speed and acceleration are expressed by using the following cart coordinate system: the X axis points to the right, the Y axis points to the front, and the Z axis points to the upper; the YZ plane passes through left and right central lines of the lifting appliance and is vertical to the ground; the origin of coordinates is a vertical projection point of the center of the lifting appliance on the ground of the storage yard when the trolley is positioned at the limit position of the rear door leg;
the definition of the spatial data used is:
1) Scale: the "length" as described herein is defined in the X-direction, the "width" is defined in the Y-direction, and the "height" is defined in the Z-direction;
2) Position: pos (Pos) X ,Pos Y ,Pos Z ) Representing coordinates as (Pos X ,Pos Y ,Pos Z ) Is a point of (2);
3) Two-dimensional projection coordinates: pos XY (x, y) represents the coordinates of the projection point of Pos on the XY plane; pos YZ (y, z) represents the projection point coordinates of Pos in the YZ plane; pos ZX (z, x) represents the projection point coordinates of Pos in the ZX plane;
4) The direction is: 0 means "stationary", -1 means "left row/back/down", and 1 means "right row/forward/up".
The definition of the geometric symbols used is:
1)Seg(Pos 1 ,Pos 2 ): end point is Pos 1 And Pos 2 Is a line segment of (2);
2)from Pos 1 To Pos 2 Is a vector of (2);
3)Rect YZ (Pos YZ w, H): the opposite sides on the YZ plane are respectively parallel to the rectangles of the Y axis and the Z axis, and the center point is Pos YZ The width is W, and the height is H;
4)Ω(Rect YZ LD): a subset of current scan data points of the laser scanner LD, wherein the vertical projection of the scan data points onto the YZ plane falls into Rect YZ And (3) inner part.
3. Basic operating parameters
The definition, symbology and acquisition modes of the basic working condition parameters related in the invention are summarized as follows:
1) Container
Length, width and height C of each box L /C W /C H Is of international standard, wherein C W The height symbols of the boxes are exactly the same:
(1) Common box: height of C H ;
(2) High box: height of C HH 。
2) Trolley
(1) Maximum walking distance of trolley between front and back door legs: TMR (TMR) W ;
(2) Braking acceleration: TKA (TKA) X Acceleration at full braking.
3) Lifting appliance
(1) Overall width: d (D) W Obtaining a design drawing;
(2) Distance between the lower bottom surface of the main girder of the lifting appliance and the top surface of the lifted operation box: DMCofs H Obtaining a design drawing;
(3) Braking acceleration: DKA (DKA) Z And the technical specification of the crane is obtained.
4. Real-time operating parameters
The definition, symbology and acquisition modes of the real-time working condition parameters related in the invention are summarized as follows:
1) Time of
T: the residence time of the cart in the present beta;
t (i): the time of the ith scanning of the front scanner and the rear scanner in the beta position is t (i) epsilon [0, T ];
2) Trolley
(1) Walking direction: TMDir Y Acquiring from a crane control system;
(2) Walking speed: TV set Y Obtained from a crane control system.
3) Lifting appliance
(1) Height of the lower bottom surface of the main girder: DMH (dimethyl formamide) Z ;
(2) Distance DCen between current position of sling center point and front-back direction of back door leg limit position Y ;
(3) Lifting direction: DVDir Z Acquiring from a crane control system;
(4) Real-time lifting speed: DV (distance vector) Z Acquiring from a crane control system;
(5) Height of lifted box: DCH (dedicated channel) H Obtained from a crane control system.
2. System architecture
1. Device composition and function
As shown in fig. 1, the device composition, the installation mode and the basic functions of the system include:
1) Laser scanner: and 2, namely a front scanner and a rear scanner, which are arranged at the front and rear positions of the crane trolley in a vertical scanning mode and positioned at the two sides of the front and rear directions of the lifting appliance, so as to acquire the real-time box column profile of the trolley at the current position in the position of the crane trolley and provide real-time scanning data for calculating the time accumulation box column profile of the position of the crane trolley.
2) And (3) a system controller: and 1, which is arranged at a proper position of the crane trolley, is communicated with the laser scanner through the Ethernet and is communicated with a crane control system through an industrial control bus. The system controller utilizes the basic working condition parameters of the crane, the real-time working condition parameters acquired from the crane control system and the real-time scanning data acquired from the laser scanner to synthesize the time accumulation box column profile of the beta position, so as to finish the judgment of the operation dangerous case and send a dangerous case avoiding operation instruction to the crane control system.
2. Laser scanner mounting mode and real-time scanning data coordinate transformation
The mounting positions of the 2 laser scanners of the system are described as follows:
1) Front scanner (FLD): the ideal installation position is on the left and right direction central position of the front surface of the trolley, and the laser scanning surface is vertical to the ground and parallel to the travelling direction of the trolley, so that the scanning origin coordinates are as follows: FLDPos (FLDPos) x ,FLDPos y ,FLDPos z ) Wherein:
(1)FLDPos x the left-right direction distance between the origin and the center point of the lifting appliance is measured for the front scanner, and the distance is adjustable;
(2)FLDPos y the front-back direction distance from the origin to the center point of the lifting appliance is measured for the front-mounted scanner, and the front-back direction distance is adjustable;
(3)FLDPos z the height of the origin from the ground of the storage yard is measured for the front scanner and is adjustable.
The conversion mode of the scanning data points of the front scanner from the equipment coordinates (X, Y) to the cart coordinates (X, Y, Z) is as follows:
2) Post scanner (RLD): the ideal mounting position is the right and left direction proper position of the rear surface of the trolley, the shielding of the cab to the scanning surface is needed to be avoided, the laser scanning surface is perpendicular to the ground and parallel to the travelling direction of the trolley, and therefore, the scanning origin coordinates are as follows: RLDPos (RLDPos) x ,RLDPos y ,RLDPos z ) Wherein:
(1)RLDPos x the left-right direction distance between the origin and the center point of the lifting appliance is measured for a rear scanner, and the distance is adjustable;
(2)RLDPos y the distance between the origin and the front-rear direction of the center point of the lifting appliance is measured for a rear scanner, and the distance is adjustable;
(3)RLDPos z the height of the origin from the ground of the storage yard is measured for the rear scanner, and the height can be adjusted.
The conversion mode of the scanning data points of the post scanner from the equipment coordinates (X, Y) to the cart coordinates (X, Y, Z) is as follows:
the installation positions of the laser scanners are ideal positions, the adjustable position parameters are required to be determined according to the actual installation conditions, and the actual measurement data points of the laser scanners can be converted into the coordinate system of the laser scanner equipment in an ideal installation mode through coordinate translation without affecting the following description.
The real-time measurement data points acquired by each laser scanner are required to be converted from a laser scanner equipment coordinate system to a cart coordinate system according to the installation mode and the installation position of the laser scanner, and the coordinates of the real-time measurement data points of the laser scanner refer to the coordinates in the cart coordinate system.
3. Main control program processing flow
As shown in fig. 2, the main control program of the system runs on the system controller to sequentially complete the following processing flows:
1) Acquiring real-time scanning data from each laser scanner;
2) Acquiring real-time working condition parameters from a crane controller, and calculating and generating composite working condition parameters;
3) Synthesizing a real-time box column outline at the current position of the trolley by the scanning data of the front scanner and the scanning data of the rear scanner;
4) Updating the time accumulation box column profile by using the real-time box column profile to obtain the time accumulation box column profile at the current position of the trolley;
5) Detecting possible dangerous situations in the current operation state;
6) If some operation dangerous case is found, a corresponding dangerous case avoiding operation instruction is sent to the crane control system.
4. Composite operating mode parameter calculation
1) Distance of braking of trolley
The trolley braking distance composite working condition parameters are matched with the time accumulation box column outline and are used for detecting the 'horizontal collision box' dangerous case, and the calculation method is as follows:
2) Combined working condition parameters of lifting appliance
The composite working condition parameters of the lifting appliance comprise a descending braking distance and the height of the lower bottom surface of the working box, are matched with the outline of the time accumulation box row and are used for detecting dangerous cases of horizontal box collision and vertical box collision, and the calculation method is as follows:
5. time accumulation bin profile synthesis
The method comprises the steps of integrating time of real-time bin profile scanning data acquired in the bin position by a front scanner and a rear scanner to acquire known bin profile information in the bin position at the current time, wherein the calculation method comprises the following steps:
fig. 3 shows a synthesis process of the time-cumulative bin profile.
6. Dangerous case judging logic and dangerous case avoiding operation instruction
The judging method of various operation dangerous cases and the dangerous case avoiding operation instruction to be adopted are as follows:
1) Horizontal touch box
The method for judging the horizontal collision case danger comprises the following steps: in the shortest braking distance range in the current travelling direction of the trolley, if there is a contour point of the time accumulated box column contour, there is a horizontal collision box danger. The horizontal collision box dangerous case detection logic and the dangerous case avoiding operation instruction are as follows:
fig. 4 shows a method of determining a horizontal touch box hazard.
2) Vertical touching box
The method for judging the dangerous case of the vertical collision box comprises the following steps: in the shortest braking distance range of the lifting appliance descending, if a time accumulated outline point of the box column outline exists, a vertical box collision dangerous situation exists, and a vertical box collision dangerous situation detection logic and a dangerous situation avoidance operation instruction are as follows:
fig. 5 illustrates a method of determining a vertical crash box hazard.