KR20040020478A - Method for controlling position of reclaimer - Google Patents

Abstract

PURPOSE: A method for controlling a discharge position of a reclaimer is provided to determine the displacement of a reclaimer moving unit to remove dangerous factors caused by the incorrect determination of the discharge position. CONSTITUTION: A reclaimer is formed to discharge fuel/material from a pile of fuel/material. A fixed coordinate is formed on the driving origin of the reclaimer(S301). A moving coordinate is determined on the reclaimer(S302). The fuel/material piles are detected in shape(S303). The detected shape of the fuel/material piles is converted into the fixed coordinate(S304). Contour lines are formed to contact an outer rotational circle of a bucket of the reclaimer to the fuel/materials piles with the shape of the fuel/material piles(S305). An initial discharge position is determined from the respective contour lines(S306). The displacement of reclaimer is calculated to approach the reclaimer to the initial discharge position(S307). The reclaimer moves to the calculated displacement(S308).

Description

Reclaimer control of dispensing posture {METHOD FOR CONTROLLING POSITION OF RECLAIMER}

The present invention relates to a reclaimer for discharging raw materials or fuel accumulated in a yard to move to a work place. More specifically, it is possible to damage the equipment by appropriately calculating the displacement of each member of the reclaimer according to the discharge position of the yard pile. It relates to a reclining dispensing posture control method to ensure efficient dispensing work without.

In steel mills, raw materials or fuels obtained, namely iron ore or coke, are piled up in a yard and transferred to adjacent processes (for example, blast furnace processes) by a fixed amount. In this case, a reclaimer connected to a belt conveyor is used as an apparatus for discharging raw materials or coke deposited in a raw material yard or a coke yard and transferring the raw material or coke to an adjacent process.

The reclaimer is configured to pour the raw material of the yard pile 1 into a belt conveyor 5 using a cylindrical rotary shovel, that is, a bucket 2, as shown in FIG. 1. .

Since the reclaimer (4) has to carry out the dispensing work over the entire yard, the bucket 41 is connected to the cab 41 where the operator instructs the dispensing work, the main body of the reclaimer 4 and the bucket (2). The vertical rotating shaft A2 is rotated horizontally with respect to the horizontal boom A1 and the boom 42 provided with a conveyor so that the material (2) transferred to the belt conveyor 5 can be transferred horizontally. Rotation member 43 for adjusting the angle in the vertical direction as a reference, and a moving member for moving the track installed so as to cover the work space of the entire yard to move the main body of the reclaimer (4) on the track ( 44).

Usually, since the pit form of coke and other raw materials has a shape which has a fixed height, the dispensing operation | work by the reclaimer 4 advances, forming several stages of work on a yard pile.

Then, the dispensing operation of the reclaimer (4) is controlled by the control system shown in Fig. 2, the shape detector (3) consisting of a three-dimensional laser scanner to scan the shape of the yard file, the scanner controller (6) The reclaimer rotating / moving member for the scanner controller 6 to analyze the shape of the yard pile scanned by the shape detector 3 to calculate the dispensing position and to move to the calculated dispensing position. Calculate their displacement. The analysis result is displayed on the monitoring terminal 8 and transmitted to the reclaimer controller 7 to move the reclaimer 4.

On the other hand, in performing such dispensing work automatically, it is necessary to control the posture of each member by a certain displacement in the reclaimer in order to move to a predetermined working position without human help. The factors that must be satisfied in this posture control are 1) accurate calculation of posture displacement for dispensing work, and safe operation without human assistance, and 2) rapid calculation to reduce time delay of dispensing process. Something that needs to be minimized.

In order to configure the displacement of each component member for the attitude control of the reclaimer, it is necessary to define a kinematic problem for the reclaimer motion and solve the inverse kinematic problem for it. In defining such an inverse kinematics problem, conventionally, the degree of freedom of a reclaimer is defined as a four degree of freedom and a three degree of freedom condition to determine the displacement of each member.

However, this method has a problem that the calculation process is very complicated, and it takes a long time to calculate the displacement of each member and also the accuracy is low.

Alternatively, a fourth boundary condition can be obtained by performing numerical calculations from planar equations using information from several points around the yard file to be accessed, but this method only solves the complexity. However, there is a problem that the accuracy of the result is difficult to guarantee.

The present invention has been proposed to solve the above-mentioned conventional problems, and an object thereof is to quickly and easily calculate the displacement of each member of the reclaimer for moving the reclaimer to the dispensing working position of the pile file, thereby reclaiming It is to provide a reclining dispensing attitude control method that can be safely moved to the dispensing operation position.

In addition, another object of the present invention is to introduce the inclination angle of the yard pile as the boundary condition to obtain the displacement of each member for the posture control of the reclaimer, thereby providing a reclaimer disposition attitude control method capable of effective disposition attitude control To provide.

1 is a side view of a general reclaimer.

Figure 2 is a block diagram showing a control system in the reclaimer.

3 is a flowchart illustrating a method for controlling a dispensing attitude of a reclaimer according to the present invention.

4 (a) and 4 (b) are coordinate system setting diagrams for determining the displacement of the reclaimer in the present invention.

5 is a view showing an embodiment of the dispensing position in the pile file.

Description of the main parts of the drawing

1: file file

2: bucket

3: shape detector

4: reclaimer

The present invention is a structural means for achieving the above object,

In the discharge attitude control method of the reclaimer for discharging fuel or raw material from the pile pile,

a) setting a fixed coordinate system (X, Y, Z) based on the driving origin of the reclaimer;

b) setting a moving coordinate system (x, y, z) as a reference point on the reclaimer;

c) detecting the shape of the pile file,

d) converting the shape of the detected file into a fixed coordinate system;

e) extracting contours from the shape of the yard pile, at which the outermost rotating source made by the reclaimer's bucket contacts the pile at each work stage;

f) determining an initial dispensing working position (Xp, Yp, Zp) in each contour;

g) Using the kinematic model of the reclaimer, the displacements ψ (horizontal rotation angle), φ (vertical rotation angle), X _l (of each member of the reclaimer, for the reclaimer to reach the initial dispensing working position. Calculating the distance traveled by the reclaimer; And,

h) displacing a reclaimer with the calculated displacement;

Characterized in that consists of.

Then, the reclaimer dispensing attitude control method according to the present invention from the initial dispensing working position (Xp, Yp, Zp)

,

,

,

(Where a is the uniaxial distance of the reclaimer bucket, R is the length of the boom, b is the radius of the circle of rotation formed by the blade blade, and α is the angle of inclination of the pile pile)

It is characterized by calculating the respective member displacement of the reclaimer by.

EMBODIMENT OF THE INVENTION Hereinafter, with reference to an accompanying drawing, the delivery method control method of the reclaimer by this invention is demonstrated in detail.

1 and 2 are structural diagrams and a control system diagram of a reclaimer to which the dispensing posture control method according to the present invention is applied, and the dispensing posture control process according to the present invention will be described with reference to FIGS. 1 and 2.

1 and 2, the shape detection of the yard pile is performed by the shape detector 3 scanning the shape of the yard pile with a three-dimensional laser, and the signal detected by the shape detector 3 to signal-process the shape of the yard pile. This is done by the scanning controller 6 which analyzes and calculates the displacement of the reclaimer angle members 43 and 44 for positioning the bucket 2 at the dispensing position and the detected dispensing position. The shape detector 3 is, for example, a three-dimensional laser scanner that emits a laser on the surface of the yard pile 1, receives a reflected laser signal, and then performs three-dimensional coordinates of various points on the surface of the yard pile 1. Serves to get.

In the above, the process of obtaining the three-dimensional coordinates of the yard file 1 is controlled by the scanning controller 6, and the extracted three-dimensional coordinates, that is, the three-dimensional shape information of the yard file 1, are scanned by the scanning controller 6. Is stored in a temporary storage place.

In addition, the scanning controller 6 extracts the contours of the points in contact with the reclaimer bucket 2 at the work stages having different heights by using the extracted three-dimensional shape, and determines the initial dispensing work position among these points. The reclaimer 4 calculates the displacement of each member to reach this point.

The amount of displacement of each member of the reclaimer 4 extracted above is transmitted to the reclaimer controller 7 which controls the movement of the reclaimer 4 to cause displacement of the reclaimer 4. The clay controller 7 and the scanning controller 6 are connected by an Ethernet communication line.

Then, the monitoring terminal 8 receives a variety of shape information of the yard file from the scanning controller 6, and displays the permanent information in a predetermined storage device when displayed.

The posture control of the reclaimer 4 detects the shape of the yard pile, sets the initial dispensing position in the detected yard pile shape, and the reclaimer 4 so that the bucket 2 contacts the set initial dispensing position. And displacing each of the members 43 and 44. In this case, the present invention relates to a process of displacing the bucket 2 in contact with the initial dispensing position after the initial dispensing position is set.

3 is a flowchart illustrating a method for controlling a dispensing posture of a reclaimer according to the present invention. Referring to the configuration of FIGS. 1 and 2, the dispensing posture process will be described in detail as follows.

First, a fixed coordinate system X, Y, Z is set based on the traveling origin of the reclaimer 4 (S301).

Further, the moving coordinate system x, y, z is set based on the position of the reclaimer 4 main body (S302).

When the coordinates of a point on the yard file (1) are defined for the fixed coordinate system and the moving coordinate system, the fixed coordinate system and the moving coordinate system are referred to as (Xp, Yp, Zp) and (xp, yp, zp), respectively. Liver is Yp = yp, Zp = zp and can be defined as Xp = X _l + xp. Here, X ₁ is the distance from the origin of the fixed coordinate system to the origin of the moving coordinate system, and at the same time, the travel distance of the reclaimer 4.

As described above, when the fixed coordinate system and the moving coordinate system are set, the shape of the yard pile 1 is detected using the shape detector 3, and the shape is represented based on the fixed coordinate system (S303, S304).

Then, at each working end shown in the shape of the detected pile file 1, the contour of the bucket 2 of the reclaimer in contact with the pile file is found. The contour is greater than the height of the work stage It is in as high a position. Here, b is the radius of the rotational circle formed by the blade of the bucket 2, and α is the inclination angle of the pile pile (1).

Then, the first dispensing position (Xp, Yp, Zp) in the contour line is determined (S306).

FIG. 5 shows an embodiment of the shape of the yard pile detected from the shape detector 3, and shows the contour lines detected in the yard pile and the starting position of each contour line.

Fig. 4A shows the distance L between the reclaimer 4 and the yard pile 1 and the heights Z and z of the fixed and moving coordinate systems, and Fig. 4B shows x of the moving coordinate system. The relationship between the y plane and the wild file is shown.

Displacement of each member of the reclaimer 4 for the bucket 2 to contact the coordinates Xp, Yp, Zp when determining any one point (Xp, Yp, Zp) of the field pile as the initial dispensing position. That is, the horizontal rotation angle φ, the vertical rotation angle φ, and the traveling distance X _l of the reclaimer ₁ are shown as shown in Figs. 4A and 4B.

That is, the vertical rotation angle φ is the angle of the boom 42 from the vertical rotation axis A2 (r ₀ , z ₀ ) when the bucket 2 is in contact with the initial dispensing position. In Figure 4 (a) R is the length of the boom, b is the radius of the rotating circle formed by the blade of the bucket.

In Fig. 4B, a is the uniaxial distance of the bucket 2, and α is the inclination of the pile pile at the initial dispensing position.

Therefore, between each variable and the displacement ψ (horizontal rotation angle), φ (vertical rotation angle), and X _l (traveling distance of the reclaimer) of the reclaimer member from Figs. The same relationship as in Equation 1 is established.

,

,

,

In the above description, x _p , y _p , z _p are the first points where the outermost circle of the bucket 2 and the contour on the discharge target file contact each other, and the geometric distance from the origin of the moving coordinate system xyz to the advantage is expressed by the following equation (2). It can be obtained as

The distance to the contact point projected on the moving coordinate L set to match the horizontal axis of rotation in a state in which the posture of the rotating member 43 of the reclaimer is rotated by ψ in the horizontal direction is to be. This can be easily confirmed from the drawing shown in Fig. 4A. In addition, x _p and y _p of Equation 2 can be obtained by separating the above distances into x and y components on the xy plane, and considering the shortened components of the bucket. In addition, z _p is represented by Equation 2 from the vertical distance from the origin to the contact point on the zL plane.

Further, according to the relationship between the moving coordinate system and the fixed coordinate system described above, since Yp = yp, Zp = zp, and Xp = X _l + xp, a relational expression as in Equation 1 appears.

Thus, following the said first discharge position (Xp, Yp, Zp) the equation Li displacement of clay Murray member by 1 ψ (horizontal rotation angle), φ (vertical rotation), X _l (Li Clay running of bots from Distance) is calculated (S307).

Then, the calculated displacement is transmitted to the reclaimer controller 7 to displace the reclaimer 2 (S308).

Determining the displacement of the reclaimer moving member according to the present invention, it is possible to eliminate the risk of dispensation due to inaccurate positioning and to simplify the displacement calculation process to perform a faster operation. In addition, by calculating the exact displacement, there is an excellent effect that the amount of displacement is incorrectly calculated, which imposes an excessive load on the reclaimer and reduces the possibility of equipment damage.

Claims (3)

In the discharge attitude control method of the reclaimer for discharging the raw material / fuel from the pile pile, a) setting a fixed coordinate system (X, Y, Z) on the traveling origin of the reclaimer; b) setting a moving coordinate system (x, y, z) on the reclaimer; c) detecting the shape of the pile file, d) converting the shape of the detected file into a fixed coordinate system; e) extracting contours from the shape of the yard pile, at which the outermost rotating source made by the reclaimer's bucket contacts the pile at each work stage; f) determining an initial dispensing working position (Xp, Yp, Zp) in each contour; g) Using the kinematic model of the reclaimer, the displacements ψ (horizontal rotation angle), φ (vertical rotation angle), X _l (of each member of the reclaimer, for the reclaimer to reach the initial dispensing working position. Calculating the distance traveled by the reclaimer; And, h) displacing a reclaimer with the calculated displacement; The reclaimer dispensing attitude control method comprising the. The process of claim 1, wherein the step of calculating the absence of the reclaimer from the initial dispensing working positions Xp, Yp, Zp is , , , (Where a is the uniaxial distance of the reclaimer bucket, R is the length of the boom, b is the radius of the circle of rotation formed by the blade blade, and α is the angle of inclination of the pile pile) The reclaimer dispensing attitude control method, characterized in that made by. The method of claim 1, wherein the reclaimer dispensing attitude control method And a horizontal reclining angle of the reclaimer at the initial dispensing position to control the discharging by the reclaimer by changing the horizontal rotation angle.