Disclosure of Invention
The invention aims to provide an automatic shipping and cabin changing method for a bulk cargo wharf, which aims to solve the problems of realizing automatic shipping and cabin changing, improving the working efficiency and quality and reducing the working intensity of staff in the background technology.
In order to achieve the above purpose, the present invention provides the following technical solutions: an automatic loading and changing method for a bulk cargo terminal, comprising the steps of:
s1: acquiring a ship number through a management and control system, determining a ship shape, determining a cabin position through scanning of a three-dimensional laser scanner, and determining a ship attitude through a ship attitude detector; and determining a target cabin for the ship loader to move according to the ship loading plan.
S2: monitoring the ship attitude in real time through a ship attitude detector, and determining a target cabin pair cabin point according to the ship attitude and the ship coordinates;
s3: after the cabin alignment point is determined, the moving route of the ship loader and the moving route of the telescopic pitching of the large arm of the ship loader are determined according to the current position and the position deviation of the target cabin to the cabin alignment point, and then the moving route of the ship loader is established.
Preferably, the cabin position is determined by modeling the ship through scanning data of a three-dimensional laser scanner arranged on the arm support of the ship loader.
Preferably, five pairs of cabin points are arranged.
Preferably, the five points of the pair of cabin points are respectively the center position o of the cabin, the position of the distance p between the center position o and the inner rod and the outer rod of the cabin opening and the position of the distance q between the center position o and the outer rod of the cabin opening in the front-back direction.
Compared with the prior art, the invention has the beneficial effects that: the invention realizes the automatic planning of the cabin changing operation path of the ship loader and ensures the safe and efficient completion of the cabin changing operation of the ship loader.
Detailed Description
The following description of the embodiments of the present invention will be made clearly and completely with reference to the accompanying drawings, in which it is apparent that the embodiments described are only some embodiments of the present invention, but not all embodiments. All other embodiments, which can be made by those skilled in the art based on the embodiments of the invention without creative efforts, are within the protection scope of the invention.
The invention provides an automatic shipment and cabin changing method for a bulk cargo wharf, which realizes automatic planning of cabin changing operation paths of a shipment machine and ensures safe and efficient completion of shipment and cabin changing operation, and comprises the following steps:
s1: the ship number is acquired through a management and control system, the ship shape is determined, the ship cabin position is determined through scanning, the ship posture is determined through a ship posture detector, the ship cabin position is determined through the scanning data of a three-dimensional laser scanner arranged on a ship loader arm frame, and the ship is modeled to determine the ship cabin position; and determining a target cabin for the movement of the ship loader according to the ship loading plan.
S2: the ship attitude is monitored in real time by a ship attitude detector, and the cabin-aligning points of the target cabin are determined according to the ship attitude and the ship coordinates, wherein the five cabin-aligning points are respectively arranged at the center position o of the ship cabin, the position of the distance p between the center position o and the inner rod and the outer rod of the ship hatch and the position point of the distance q between the center position o and the front and rear directions of the ship cabin opening;
s3: after the cabin alignment point is determined, determining a moving route of the ship loader moving and the telescopic pitching of the big arm of the ship loader according to the current position and the target position, and finding out the position deviation of the current position and the target cabin to the cabin point, so as to establish a moving route of the ship loader.
Examples
Acquiring a ship number through a management and control system, further determining a ship shape, acquiring scanning data of a three-dimensional laser scanner arranged on an arm support of a ship loader, modeling a ship, determining the position of a cabin, and acquiring data of a ship attitude detector to determine the ship attitude;
the cabin changing of the ship loader is to move the ship loader from the current cabin to the target cabin according to a ship loading plan, so that the moving distance between the ship loader and the large arm in the cabin changing process is shortened as much as possible on the premise of ensuring cabin moving safety in order to ensure the shortest cabin changing time;
the ship attitude is monitored in real time, target cabin alignment points are determined according to the ship attitude and ship coordinates, 5 cabin alignment points are arranged, as shown in fig. 1, the center position o of the ship cabin, the position of the distance p between the inner rod and the outer rod of the ship hatch and the position point of the distance q between the inner rod and the outer rod of the ship cabin and the front and rear directions of the ship cabin mouth are set, if the length and the width of the ship cabin are respectively m and n, the diameter of a chute is d, and the anti-collision safety threshold is g, the ship is provided with the following characteristics that
Because the ship is a rigid object, the inclination angles of each position of the ship are consistent, so that the data of the ship attitude detectors are directly collected to determine the opposite cabin points, to determine which point is specifically adopted for opposite cabin, the ship attitudes (inner rod, outer rod, front position and rear position) in four directions of the ship need to be observed, the ship inclination angles take the ship attitude detectors as coordinate origins, the direction vertical to the outer rod of the central axis is the positive direction of the x axis, the direction parallel to the backward direction of the central axis of the ship is the positive direction of the y axis, the vertical direction is the positive direction of the z axis, the xoz plane inclination angle is taken as a roll angle alpha, and the inclination angle of the yoz plane is taken as a pitch angle beta, as shown in fig. 2, wherein alpha is more than or equal to 0 is higher than the inner rod, and beta is more than or equal to 0 is higher than the front after the ship;
observing the deviation of the roll angle and the pitch angle, if the roll angle is not smaller than the pitch angle, namely |alpha| is not smaller than |beta|, positioning the number 4 or the number 5, if alpha is larger than 0 on the basis, positioning the number 5 of the cabin, otherwise, positioning the number 3 or the number 4 of the cabin, if the roll angle is smaller than the pitch angle, namely |alpha| < |beta|, positioning the number 2 of the cabin, otherwise, positioning the number 1 of the cabin, if beta is larger than 0 on the basis;
after the cabin alignment point is determined, determining a moving route of the ship loader moving and the telescopic pitching of the large arm of the ship loader according to the current position and the target position, analyzing a ship model, building the ship model by adopting three-dimensional laser scanner data, finding the position deviation of the current position and the target cabin to the cabin point, and further building a moving route of the ship loader;
in order to ensure the safety of the loading and cabin moving process, the highest point between two cabins is selected as the lowest point of the lifting of the large arm, the ship model takes the origin of the track of the ship loader as the origin of coordinates, the horizontal direction is parallel to the coast direction as the x axis, the horizontal direction is perpendicular to the coast direction as the y axis, the vertical direction is upwards as the z axis, the height of the ship, the hatch and the cabin cover which are most likely to collide between the two cabins is scanned according to the ship model, and the highest height is calculated;
in order to prevent collision between the large arm slide cylinder and the cabin in the cabin changing and moving process of the ship loader, the large arm is lifted firstly when a path is arranged, so that the lowest position of the large arm is higher than the highest position of a ship, and the whole length (fixed part l 1 +telescoping section l 2 ) In the step (1), the height of the pitching supporting point of the large arm of the ship loader is h, the highest position of the ship is e, the length of the chute is f, and the safety threshold is set to be t, so that the lifting angle of the large arm of the ship loader isAs shown in fig. 3;
after the big arm is lifted, the ship loader starts to walk, moves to the target position and receives wind power and wavesThe ship is stopped and at the shore with a certain inclination angle, so that the target point is required to be converted to obtain the position to be moved, the ship course angle is assumed to be theta, and the position coordinate corresponding to the current chute is A (x 1 ,y 1 ,z 1 ) The coordinates of the target position are B (x 2 ,y 2 ,z 2 ) The ship loader moves forward a distance ofAs shown in fig. 4;
after moving to the target position, the ship loader lowers the large arm to the target position, and simultaneously stretches the large arm, so that the whole length of the large arm is y2, the target length of the stretching part is l2=y2-l 1, and the target angle of pitching isThis was successful for the capsule as shown in figure 5.
Although the invention has been described hereinabove with reference to embodiments, various modifications thereof may be made and equivalents may be substituted for elements thereof without departing from the scope of the invention. In particular, the features of the disclosed embodiments may be combined with each other in any manner so long as there is no structural conflict, and the exhaustive description of these combinations is not given in this specification merely for the sake of brevity and resource saving. Therefore, it is intended that the invention not be limited to the particular embodiments disclosed herein, but that the invention will include all technical aspects falling within the scope of the appended claims.