WO2023166885A1 - Procédé d'étalonnage d'informations - Google Patents

Procédé d'étalonnage d'informations Download PDF

Info

Publication number
WO2023166885A1
WO2023166885A1 PCT/JP2023/002169 JP2023002169W WO2023166885A1 WO 2023166885 A1 WO2023166885 A1 WO 2023166885A1 JP 2023002169 W JP2023002169 W JP 2023002169W WO 2023166885 A1 WO2023166885 A1 WO 2023166885A1
Authority
WO
WIPO (PCT)
Prior art keywords
information
measurement
bucket
boom
arm
Prior art date
Application number
PCT/JP2023/002169
Other languages
English (en)
Japanese (ja)
Inventor
隆之 片岡
崇幸 篠田
光 内田
創一 茨木
Original Assignee
株式会社小松製作所
国立大学法人広島大学
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社小松製作所, 国立大学法人広島大学 filed Critical 株式会社小松製作所
Publication of WO2023166885A1 publication Critical patent/WO2023166885A1/fr

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • G—PHYSICS
    • G01—MEASURING; TESTING
    • G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C15/00—Surveying instruments or accessories not provided for in groups G01C1/00 - G01C13/00

Definitions

  • the present disclosure relates to an information calibration method for calibrating information about work machines.
  • Information-aided construction is the use of information and communication technology (ICT) in the construction and civil engineering business to achieve highly efficient and highly accurate construction.
  • ICT information and communication technology
  • GNSS Global Navigation Satellite Systems
  • Machine guidance techniques have been proposed to provide differential information to a work machine cab monitor.
  • a hydraulic excavator is one of the work machines.
  • a hydraulic excavator may include a working machine that includes a boom, an arm, and a bucket.
  • the boom, arm and bucket may in turn be pivotally supported by pins.
  • Non-Patent Document 1 describes measuring the dimensions between pins and bucket dimensions of each movable part such as arm dimensions of an ICT hydraulic excavator.
  • this position data refers to the position data of the tip of the bucket.
  • the position data of the tip of the bucket is calculated from the position information of the GNSS antenna provided in the main body of the hydraulic excavator, the geometric shape of the work machine, and the information of the attitude of the work machine. Geometry includes the distance between each pin of the links that make up the implement. The distance between each pin is stored as information in the in-machine controller and calibrated prior to installation.
  • a survey target is attached to each pin position, and the position of each pin is measured using a surveying instrument such as a total station or laser tracker. Ta.
  • a surveying instrument such as a total station or laser tracker. Ta.
  • This disclosure proposes an information calibration method that can inexpensively and easily calibrate information about work machines for information-aided construction.
  • an information calibration method for calibrating information about work machines is proposed.
  • the working machine has a vehicle body and a working machine that is relatively movable with respect to the vehicle body.
  • a measurement target is set on the working machine of the working machine.
  • the information calibration method comprises the following processes.
  • the first process is to sequentially stop the measurement target at at least three different measurement points on the plane.
  • the second process is to measure the posture of the work implement with respect to the vehicle body while the measurement target is stopped at each measurement point.
  • the third process is to measure the distance between each measurement point.
  • the fourth processing is the calculation of the measurement points using the measurement coordinates of the measurement points based on the distance between the measurement points in the coordinate system defined on the plane, and the attitude of the work machine and information about the work machine. and updating the information by deriving information that minimizes the difference between the coordinates.
  • FIG. 1 is an external view of a hydraulic excavator; FIG. It is a side view of a hydraulic excavator.
  • FIG. 4 is a flow diagram showing a flow of processing for calibrating information about a hydraulic excavator;
  • FIG. 11 is a schematic side view showing an operation of aligning the cutting edge of the bucket with the first measurement point;
  • FIG. 11 is a schematic side view showing an operation of aligning the blade edge of the bucket with the second measurement point;
  • FIG. 11 is a schematic side view showing an operation of aligning the blade edge of the bucket with the third measurement point; It is a side schematic diagram showing the coordinates of the boom pin.
  • FIG. 1 is an external view of a hydraulic excavator 100 as an example of a working machine whose information is calibrated by the information calibrating method based on the embodiment.
  • a hydraulic excavator 100 will be described as an example of a working machine.
  • the hydraulic excavator 100 has a main body 1 and a work machine 2 that operates hydraulically.
  • the main body 1 has a revolving body 3 and a traveling body 5 .
  • the traveling body 5 has a pair of crawler belts 5Cr and a traveling motor 5M.
  • the traveling motor 5M is provided as a drive source for the traveling body 5.
  • the traveling motor 5M is a hydraulic motor operated by hydraulic pressure.
  • the traveling body 5 is in contact with the ground.
  • the traveling body 5 can travel on the ground by rotating the crawler belt 5Cr.
  • the traveling body 5 may have wheels (tires) instead of the crawler belts 5Cr.
  • the revolving body 3 is arranged on the running body 5 and supported by the running body 5 .
  • the revolving body 3 is relatively movable with respect to the traveling body 5 .
  • the revolving body 3 is mounted on the running body 5 so as to be able to revolve with respect to the running body 5 about the revolving axis RX.
  • the revolving body 3 is mounted on the traveling body 5 via a revolving circle portion.
  • the turning circle portion is arranged substantially in the center of the main body 1 in plan view.
  • the turning circle portion has an annular general shape, and has internal teeth for turning on its inner peripheral surface.
  • a pinion that meshes with the internal teeth is attached to a turning motor (not shown).
  • the revolving body 3 can rotate relative to the traveling body 5 by rotating the revolving circle portion by transmitting the driving force from the revolving motor.
  • the revolving body 3 has a cab 4.
  • a crew member (operator) of the hydraulic excavator 100 rides on the cab 4 and steers the hydraulic excavator 100 .
  • the cab 4 is provided with a driver's seat 4S on which an operator sits.
  • An operator can operate the excavator 100 inside the cab 4 .
  • the operator can operate the work implement 2 , can swivel the revolving body 3 with respect to the traveling body 5 , and can operate the excavator 100 to travel by the traveling body 5 .
  • the excavator 100 may be wirelessly remotely controlled from a location away from the excavator 100 .
  • the front-back direction refers to the front-back direction of the operator seated on the driver's seat 4S.
  • the direction facing the operator seated on the driver's seat 4S is the forward direction, and the direction behind the operator seated on the driver's seat 4S is the rearward direction.
  • the left-right direction refers to the left-right direction of the operator seated on the driver's seat 4S.
  • the right side and the left side when an operator sitting in the driver's seat 4S faces the front are the right direction and the left direction, respectively.
  • the vertical direction refers to the vertical direction of the operator seated on the driver's seat 4S.
  • the operator seated on the driver's seat 4S faces the lower side, and the upper side faces the operator's head.
  • the side where the working machine 2 protrudes from the revolving body 3 is the front direction
  • the direction opposite to the front direction is the rear direction.
  • the right side and the left side in the horizontal direction are the right direction and the left direction, respectively, when viewed in the forward direction.
  • the side with the ground is the lower side
  • the side with the sky is the upper side.
  • the revolving body 3 has an engine room 9 in which the engine is housed, and a counterweight provided at the rear part of the revolving body 3 .
  • an engine that generates a driving force a hydraulic pump that receives the driving force generated by the engine and supplies working oil to the hydraulic actuators, and the like are arranged.
  • the electric excavator may have a storage battery instead of the engine, drive an electric motor with electric power stored in the storage battery, and operate a hydraulic pump using the driving force of the electric motor.
  • a handrail 19 is provided in front of the engine room 9 in the revolving body 3 .
  • An antenna 21 is provided on the handrail 19 .
  • Antenna 21 is, for example, a GNSS antenna.
  • the antenna 21 has a first antenna 21A and a second antenna 21B provided on the revolving body 3 so as to be separated from each other in the horizontal direction.
  • the work machine 2 is mounted on the revolving body 3 and supported by the revolving body 3 .
  • the work implement 2 has a boom 6 , an arm 7 and a bucket 8 .
  • the boom 6 is rotatably connected to the revolving body 3 .
  • Arm 7 is rotatably connected to boom 6 .
  • Bucket 8 is rotatably connected to arm 7 .
  • Bucket 8 has a plurality of blades. A tip portion of the bucket 8 is referred to as a cutting edge 8a.
  • the bucket 8 may not have blades.
  • the tip of the bucket 8 may be formed of a straight steel plate.
  • the base end of the boom 6 is connected to the revolving body 3 via a boom foot pin 13 (hereinafter referred to as "boom pin”).
  • a base end portion of the arm 7 is connected to a tip end portion of the boom 6 via an arm connection pin 14 (hereinafter referred to as an arm pin).
  • the bucket 8 is connected to the tip of the arm 7 via a bucket connecting pin 15 (hereinafter referred to as bucket pin).
  • the boom 6 is movable relative to the revolving body 3.
  • the boom 6 is rotatable relative to the revolving body 3 around the boom pin 13 .
  • the boom pin 13 is provided on the revolving body 3 .
  • the boom pin 13 forms a reference point that serves as a reference for relative movement of the work implement 2 with respect to the revolving body 3 .
  • Arm 7 is relatively movable with respect to boom 6 .
  • the arm 7 is rotatable relative to the boom 6 around the arm pin 14 .
  • Bucket 8 is relatively movable with respect to arm 7 .
  • Bucket 8 is rotatable relative to arm 7 around bucket pin 15 .
  • the arm 7 and the bucket 8 are integrally movable relative to the boom 6, specifically rotatable relative to each other, while the bucket 8 does not rotate relative to the arm 7.
  • the boom 6, the arm 7 and the bucket 8 are integrally movable relative to the revolving structure 3 while the bucket 8 does not rotate relative to the arm 7 and the arm 7 does not rotate relative to the boom 6. , specifically relatively rotatable.
  • the boom 6 of the work machine 2 rotates around the boom pin 13 provided at the base end of the boom 6 with respect to the revolving body 3 .
  • a locus along which a specific portion of the boom 6 that rotates relative to the revolving body 3, such as the tip of the boom 6, moves is arcuate.
  • a plane containing the arc is identified as the motion plane P shown in FIG.
  • the action plane P is a plane that extends in the vertical direction and in the front-rear direction.
  • the operation plane P is a plane that is located at the center of the work machine 2 in the left-right direction, includes the center axis of the revolving body 3, and extends in the up-down direction and the front-rear direction.
  • the boom pin 13, the arm pin 14, and the bucket pin 15 extend in a direction perpendicular to the plane of motion P, that is, in the left-right direction.
  • the plane of operation P is orthogonal to at least one (all three in the embodiment) of the axis of each of the boom 6 , the arm 7 and the bucket 8 .
  • the boom 6 rotates with respect to the revolving body 3 on the operation plane P.
  • the arm 7 rotates relative to the boom 6 on the plane P of motion
  • the bucket 8 rotates relative to the arm 7 on the plane P of motion.
  • the work machine 2 of the embodiment operates on the action plane P in its entirety in its longitudinal direction.
  • the cutting edge 8a of the bucket 8 moves on the action plane P.
  • the action plane P is a plane that includes the movable range of the work implement 2 .
  • a plane of motion P intersects each of boom 6 , arm 7 and bucket 8 .
  • the plane of motion P can be set at the center of the boom 6, the arm 7 and the bucket 8 in the lateral direction.
  • one direction on the motion plane P is set as the X-axis
  • a direction orthogonal to the one direction on the motion plane P is set as the Z-axis.
  • the X-axis and Z-axis are orthogonal to each other. The setting of the coordinate axes on the motion plane P will be described later.
  • the working machine 2 has a boom cylinder 10 , an arm cylinder 11 and a bucket cylinder 12 .
  • a boom cylinder 10 drives the boom 6 .
  • Arm cylinder 11 drives arm 7 .
  • Bucket cylinder 12 drives bucket 8 .
  • Each of the boom cylinder 10, the arm cylinder 11, and the bucket cylinder 12 is a hydraulic cylinder driven by hydraulic fluid.
  • the work machine 2 constitutes a link mechanism in which a plurality of link members are connected via joints.
  • the boom 6, arm 7 and bucket 8 each constitute a link member.
  • the boom pin 13 corresponds to a joint that connects the revolving body 3 and the boom 6 .
  • Arm pin 14 corresponds to a joint that connects boom 6 and arm 7 .
  • Bucket pin 15 corresponds to a joint that connects arm 7 and bucket 8 .
  • the bucket cylinder 12 is attached to the arm 7.
  • the bucket 8 rotates with respect to the arm 7 by expanding and contracting the bucket cylinder 12 .
  • the work machine 2 has a bucket link.
  • the bucket link connects the bucket cylinder 12 and the bucket 8 .
  • a controller 26 is mounted on the hydraulic excavator 100 .
  • the controller 26 controls operations of the excavator 100 .
  • the controller 26 is a computer including a CPU (Central Processing Unit), a nonvolatile memory, a timer, and the like.
  • FIG. 2 is a side view of hydraulic excavator 100 shown in FIG. As shown in FIG. 2, the excavator 100 further includes a boom IMU (Inertial Measurement Unit) 32, an arm IMU 33, and a bucket IMU . Boom IMU 32, arm IMU 33, and bucket IMU 34 are inertial measurement units.
  • boom IMU 32, arm IMU 33, and bucket IMU 34 are inertial measurement units.
  • the boom IMU 32 is attached to the boom 6.
  • Arm IMU 33 is attached to arm 7 .
  • Bucket IMU 34 is attached to bucket 8 .
  • the boom IMU 32, the arm IMU 33, and the bucket IMU 34 respectively detect the acceleration of the boom 6, the arm 7, and the bucket 8 in the longitudinal, lateral, and vertical directions, and the acceleration of the boom 6, the arm 7, and the bucket in the longitudinal, lateral, and vertical directions. 8 angular velocities are measured.
  • the angle of the boom 6 is calculated from the detection result of the boom IMU 32.
  • the angle of arm 7 is detected from the detection result of arm IMU 33 .
  • the angle of the bucket 8 is calculated from the detection result of the bucket IMU 34 .
  • Boom IMU 32, arm IMU 33, and bucket IMU 34 constitute an angle sensor that measures the attitude of work implement 2 with respect to revolving body 3 (the vehicle body of hydraulic excavator 100).
  • the boom IMU 32 detects the attitude (angle) of the boom 6 with respect to the direction of gravity.
  • Arm IMU 33 detects the posture (angle) of arm 7 with respect to the direction of gravity.
  • Bucket IMU 34 detects the attitude (angle) of bucket 8 with respect to the direction of gravity.
  • the angle sensor may include any other sensor in addition to each IMU described above.
  • the angle sensor uses a cylinder stroke sensor attached to the boom cylinder 10, the arm cylinder 11 or the bucket cylinder 12 that detects the amount of displacement of the cylinder rod with respect to the cylinder. 7.
  • the posture (angle) of the bucket 8 may be obtained.
  • the angle sensor may be a potentiometer or rotary encoder attached to boom pin 13 , arm pin 14 or bucket pin 15 .
  • a detection result of the angle sensor is input to the controller 26 (FIG. 1).
  • the distance bm shown in FIG. 2 is the distance between the boom pin 13 and the arm pin 14.
  • the distance bm is also called the link length of the boom 6 .
  • a distance am is the distance between the arm pin 14 and the bucket pin 15 .
  • Distance am is also referred to as the link length of arm 7 .
  • the distance cm is the distance between the bucket pin 15 and the cutting edge 8 a of the bucket 8 .
  • the distance cm is also called the link length of the bucket 8 .
  • FIG. 3 is a flow diagram showing the flow of processing for calibrating information regarding the hydraulic excavator 100.
  • FIG. Details of the process of calibrating the information about the hydraulic excavator 100 will be described below with appropriate reference to FIG. 3 and subsequent figures.
  • the process of calibrating information about the excavator 100 may be executed by the controller 26 mounted on the excavator 100, or may be executed by an external controller or information processing device.
  • an externally provided controller executes processing for calibrating information related to the hydraulic excavator 100
  • the controller 26 mounted on the hydraulic excavator 100 transmits the detection result of the angle sensor to the external controller.
  • the information about the hydraulic excavator 100 calibrated by the following processing is used to accurately derive the position of the cutting edge 8a of the bucket 8 and improve the accuracy of the calculation of the position of the work implement 2 when performing information-aided construction. It is necessary information.
  • Information about the excavator 100 to be calibrated includes, for example, the dimensions of the work implement 2 of the excavator 100 .
  • the distance bm, distance am, and distance cm are included in the information about the work machine.
  • the information about the excavator 100 may be position coordinate information of a predetermined portion of the excavator 100 in a three-dimensional space, distance information between two predetermined portions, and the like.
  • the coordinate system of the three-dimensional space may be the ITRF (International Terrestrial Reference Frame) coordinate system.
  • a measurement target is set.
  • a measurement target is set at one location on the work implement 2 of the hydraulic excavator 100 .
  • the bucket 8 is the tip link member that is farthest from the revolving body 3 .
  • a measurement target is set at one point of the bucket 8 which is a link member at the tip.
  • the cutting edge 8a of the bucket 8 is set as the measurement target.
  • step S1 the cutting edge 8a of the bucket 8 is aligned with the measurement point A1.
  • FIG. 4 is a schematic side view showing the operation of aligning the cutting edge 8a of the bucket 8 with the measurement point A1.
  • step S2 with the cutting edge 8a of the bucket 8 stopped at the measurement point A1, the angle of each link member of the working machine 2 detected by each angle sensor is acquired.
  • the angle of the boom 6 is detected by the boom IMU 32
  • the angle of the arm 7 is detected by the arm IMU 33
  • the angle of the bucket 8 is detected by the bucket IMU 34 when the cutting edge 8a of the bucket 8 is at the measurement point A1.
  • the posture of the working machine 2 with respect to the revolving body 3 is measured while the cutting edge 8a is stopped at the measuring point A1.
  • FIG. 5 is a schematic side view showing the operation of aligning the cutting edge 8a of the bucket 8 with the measurement point A2.
  • the cutting edge 8a of the bucket 8 is brought into contact with the ground or the like at a position different from the measurement point A1.
  • the cutting edge 8a is moved forward (in the direction away from the vehicle body) and brought into contact with the ground at a position forward of the measurement point A1.
  • the working machine 2 is stopped in that posture.
  • the position of the cutting edge 8a at that time is defined as a measurement point A2.
  • the cutting edge 8a which is the measurement target, is moved from the measurement point A1 to the measurement point A2 different from the measurement point A1.
  • the boom 6 is lowered and the arm 7 and the bucket 8 are moved forward.
  • step S4 the X direction is set.
  • the direction connecting the measurement points A1 and A2 is set as the X-axis on the motion plane P.
  • the X direction is the horizontal direction.
  • step S5 with the cutting edge 8a of the bucket 8 stopped at the measurement point A2, the angle of each link member of the working machine 2 detected by each angle sensor is obtained.
  • the angle of the boom 6 is detected by the boom IMU 32
  • the angle of the arm 7 is detected by the arm IMU 33
  • the angle of the bucket 8 is detected by the bucket IMU 34 when the cutting edge 8a of the bucket 8 is at the measurement point A2.
  • the posture of the working machine 2 with respect to the revolving body 3 is measured while the cutting edge 8a is stopped at the measuring point A2.
  • step S6 the distance between the measurement points A1 and A2 is measured.
  • This distance measurement may be performed using an inexpensive length measuring device such as a laser length measuring device.
  • a measurement result of the length measuring device may be input to a controller that executes a process of calibrating information regarding the hydraulic excavator 100 .
  • a length measuring device When a length measuring device is used, a reflector that reflects laser light may be attached to the cutting edge 8a of the bucket 8, which is the measurement target, and a marker may be provided to facilitate recognition of the position.
  • the reflector reflects light in the same direction as the direction in which the laser light is emitted.
  • the operator may manually measure the distance using a wire-type length measuring device, a tape measure, or the like. The operator may manually input the measurement results into the controller.
  • the cutting edge 8a of the bucket 8 is brought into contact with the ground, but by attaching a water thread to the cutting edge 8a of the bucket 8 and hanging it, the X direction is set without contacting the cutting edge 8a with the ground. is also possible.
  • step S7 the cutting edge 8a of the bucket 8 is aligned with the measurement point A3.
  • FIG. 6 is a schematic side view showing the operation of aligning the cutting edge 8a of the bucket 8 with the measurement point A3.
  • the cutting edge 8a of the bucket 8 is moved above the measurement points A1 and A2.
  • the working machine 2 is stopped in that posture.
  • the position of the cutting edge 8a at that time is defined as a measurement point A3.
  • the cutting edge 8a which is the measurement target, is moved to a measurement point A3 different from the measurement points A1 and A2 on the plane containing the measurement points A1 and A2.
  • the boom 6 is raised and the arm 7 and bucket 8 are moved backward.
  • Measurement points A1, A2, and A3 are set on an operation plane P, which is a plane.
  • the measurement points A1, A2, A3 form a triangle with each point as the vertex.
  • FIG. 6 shows an example in which the measurement point A3 is between the measurement points A1 and A2 in the front-rear direction (horizontal direction in the drawing). , or may be further away from the vehicle body than the measurement point A2.
  • step S8 the Z direction is set.
  • the direction of the perpendicular drawn from the measuring point A3 to the straight line connecting the measuring points A1 and A2 is set as the Z-axis on the operating plane P.
  • the Z direction is up and down.
  • the measurement point A1 is set as the origin
  • the direction connecting the measurement points A1 and A2 is set as the X axis
  • the direction perpendicular to the X axis is set as the Z axis.
  • a measurement coordinate system is defined on the operation plane P.
  • step S9 with the cutting edge 8a of the bucket 8 stopped at the measurement point A3, the angle of each link member of the working machine 2 detected by each angle sensor is acquired.
  • the angle of the boom 6 is detected by the boom IMU 32
  • the angle of the arm 7 is detected by the arm IMU 33
  • the angle of the bucket 8 is detected by the bucket IMU 34 when the cutting edge 8a of the bucket 8 is at the measurement point A3.
  • the posture of the working machine 2 with respect to the revolving body 3 is measured while the cutting edge 8a is stopped at the measuring point A3.
  • step S10 the distance between measurement points A1 and A3 is measured, and the distance between measurement points A2 and A3 is measured.
  • This distance measurement may be performed using an inexpensive length-measuring device, or may be performed manually, as in step S6.
  • step S11 the measurement coordinates of the measurement point A3 are set.
  • the X coordinate of the measurement point A3 be the distance from the point where the X axis intersects with the perpendicular drawn from the measurement point A3 to the measurement point A1 (origin).
  • the Z coordinate of the measurement point A3 is defined as the length between two points, starting from the measurement point A3 and ending at the point at which the perpendicular to the X axis intersects the X axis.
  • the distance between the measurement points A1 and A2 measured in step S6, the distance between the measurement points A1 and A3 measured in step S10, and the distance between the measurement points A2 and A3 is used to calculate the cosine of the angle between the straight line connecting the measurement points A1 and A3 and the X-axis by the cosine theorem, and from this cosine and the distance between the measurement points A1 and A3, the measurement point A3 may be obtained.
  • the sine of the angle between the straight line connecting the measurement points A1 and A3 and the X-axis is calculated by the trigonometric ratio formula, and the distance between the measurement points A1 and A3 is used to calculate the angle of the measurement point A3.
  • a Z coordinate may be determined.
  • the work machine 2 is operated to move the cutting edge 8a to a position other than the measurement points A1, A2, and A3, and the information calibration method shown in this embodiment is used to determine each coordinate. Calculation should be performed.
  • step S12 the initial values of the information used to calculate the calculated coordinates of the measurement points are entered.
  • the information used to calculate the calculated coordinates of the measurement points is the X coordinate Xbf of the boom pin 13, the Z coordinate Zbf of the boom pin 13, the link length bm of the boom 6, the link length am of the arm 7, the link length cm of the bucket 8, the link length cm of the arm 7,
  • the offset value ⁇ of for the output value ⁇ of the boom IMU 32 that detects the angle of the boom 6, and the offset value ⁇ of for the output value C of the bucket IMU 34 that detects the angle of the bucket 8. value Cof.
  • FIG. 7 is a schematic side view showing the coordinates of the boom pin 13.
  • the X-axis and Z-axis are set with the measurement point A1 as the origin.
  • the X coordinate Xbf of the boom pin 13 is the distance in the X direction (horizontal direction, for example) between the boom pin 13 and the measurement point A1.
  • the Z coordinate Zbf of the boom pin 13 is the distance in the Z direction (for example, vertical direction) between the boom pin 13 and the X axis (for example, the ground).
  • the design value of the dimension from 13 to the lower surface of crawler belt 5Cr may be used as the initial value.
  • a design value is a dimension of each part determined for manufacturing the hydraulic excavator 100 .
  • Design values can be used for the initial values of the link length bm of the boom 6, the link length am of the arm 7, and the link length cm of the bucket 8.
  • the initial values of the angle sensor offset values ⁇ of, ⁇ of, and Cof may be zero. These initial values are input to a controller that executes processing for calibrating information about the excavator 100 .
  • An automatic input from the length measuring device to the controller may be performed, or a manual input to the controller may be performed.
  • the controller may have an information storage section for storing information, and part or all of the information, such as the design value of the link length, may be stored in advance in the information storage section.
  • the X coordinate Xat of the arm pin 14 is expressed by the following equation (1): Calculate with
  • the Z coordinate Zat of the arm pin 14 is calculated by the following formula (2).
  • Equation (3) Calculate with
  • the Z coordinate Ztt of the cutting edge 8a of the bucket 8 is calculated by the following formula (4) using the Zat calculated by the formula (2), the output value C of the bucket IMU 34, and the initial values of each information.
  • the number of measurement points is n, and the following description will be made using mathematical formulas. Measurement coordinates are obtained for n measurement points, and calculated coordinates of the measurement target corresponding to those measurement points are calculated. The n calculated coordinates can be expressed using a matrix, as in Equation (5).
  • the measurement coordinates for the n measurement points can be expressed using a matrix as shown in Equation (6).
  • each piece of information about the working machine 2 is derived by the method of least squares.
  • the derived information includes the X coordinate Xbf of the boom pin 13, the Z coordinate Zbf of the boom pin 13, the link length bm of the boom 6, the link length am of the arm 7, the link length cm of the bucket 8, and the angle of the arm 7.
  • the offset value ⁇ of for the output value ⁇ of the arm IMU 33 to be detected, the offset value ⁇ of for the output value ⁇ of the boom IMU 32 for detecting the angle of the boom 6, and the offset value Cof for the output value C of the bucket IMU 34 for detecting the angle of the bucket 8. is.
  • Information related to the work implement 2 is derived so as to minimize the difference between the measured coordinates Ptt of the measurement point given by Equation (6) and the calculated coordinates P * tt of the measurement point given by Equation (5).
  • the Newton method was used as described in the reference.
  • the nonlinear least-squares method it is possible to simultaneously derive each piece of information including the length of the link member of the working machine 2 and the offset value of the angle sensor.
  • step S14 the information is updated.
  • the initial value of the information about the work machine 2 stored in the information storage unit of the controller is overwritten with the value derived in step S13 to update the information about the work machine 2 .
  • END a series of processes for calibrating the information on the hydraulic excavator 100 is completed (“END” in FIG. 3).
  • the measurement coordinate system is specified in steps S4 and S8, but the measurement coordinates of the measurement points may be obtained based on the distances of the measurement points without specifying the measurement coordinate system.
  • step S1 the cutting edge 8a, which is the measurement target, is sequentially stopped at the measurement points A1, A2, and A3.
  • steps S2, S5, and S9 the posture of the work implement 2 with respect to the vehicle body is measured while the cutting edge 8a is stopped at each of the measurement points A1, A2, and A3.
  • steps S6 and S10 the distances between the measurement points A1, A2 and A3 are measured.
  • step S13 information for minimizing the difference between the measurement coordinates of the measurement points based on the distance between the measurement points and the calculated coordinates of the measurement points calculated using the attitude of the work machine 2 and the information on the work machine is obtained. derive
  • step S14 information is updated.
  • the work machine 2 has a revolving structure 3 and a boom 6 connected via a boom pin 13, a boom 6 and an arm 7 connected via an arm pin 14, and an arm 7 and a bucket. 8 are connected via a bucket pin 15.
  • Information calibrated by the information calibration method of the embodiment includes the distance between boom pin 13 and arm pin 14 and the distance between arm pin 14 and bucket pin 15 . From this distance information, the link length bm of the boom 6 and the link length am of the arm 7 shown in FIG. 2 can be calibrated appropriately.
  • the measurement target is set on the bucket 8, which is the tip link member of the plurality of link members.
  • Information calibrated by the information calibrating method of the embodiment includes the position of the cutting edge 8a, which is the measurement target, and the distance between the bucket pin 15. FIG. From this distance information, the link length cm of the bucket 8 shown in FIG. 2 can be calibrated appropriately.
  • the hydraulic excavator 100 further has a boom IMU 32, an arm IMU 33, and a bucket IMU 34.
  • Boom IMU 32 , arm IMU 33 , and bucket IMU 34 function as angle sensors that measure the attitude of work implement 2 .
  • Information calibrated by the information calibration method of the embodiment includes offset values for output values of boom IMU 32 , arm IMU 33 and bucket IMU 34 . This allows the angle sensor to be properly calibrated.
  • the revolving body 3 of the hydraulic excavator 100 is provided with a boom pin 13 that serves as a reference point for relative movement of the work implement 2 with respect to the revolving body 3 .
  • Information calibrated by the information calibrating method of the embodiment includes the X coordinate Xbf of the boom pin 13 and the Z coordinate Zbf of the boom pin 13 in the coordinate system defined on the operation plane P. This allows the position of the boom pin 13 to be properly calibrated.
  • the information calibration method of the embodiment further comprises a step S4 of setting the X-axis on the motion plane P, which is a plane, and a step S8 of setting the Z-axis on the motion plane P.
  • a step S4 of setting the X-axis on the motion plane P which is a plane
  • a step S8 of setting the Z-axis on the motion plane P there is By setting a coordinate system based on the measurement points A1, A2, and A3 as shown in FIGS. , information about the work machine can be calibrated.
  • the measurement point A1 is set as the origin on the operation plane P, and the direction connecting the measurement points A1 and A2 is set as the X axis on the operation plane P.
  • the direction orthogonal to the X-axis can be set as the Z-axis, thereby easily setting the XZ orthogonal coordinate system.
  • the blade edge 8a of the bucket 8 may be brought into contact with the ground or the like at one or more positions between the measurement points A1 and A2, and the position of the blade edge 8a at that time may be used as the measurement point.
  • the blade edge 8a of the bucket 8 may be moved to one or more positions above the measurement points A1 and A2 and different from the measurement point A3, and the position of the blade edge 8a at that time may be used as the measurement point.
  • the value of the angle sensor may be obtained multiple times while the cutting edge 8a of the bucket 8 is stopped at each measurement point.
  • the cutting edge 8a at the tip of the working machine 2 may drop naturally due to deviation due to backlash of each link member of the working machine 2, minute leakage peculiar to the hydraulic system, or the like.
  • the angle sensor value is acquired in step S5, and after the distance is measured, the angle sensor value is acquired again to confirm that there is no difference in the angle sensor value. It may have functions.
  • the hydraulic excavator 100 is given as an example of a working machine, but the excavator is not limited to the hydraulic excavator 100, and other types of work such as loading excavators, mechanical rope excavators, electric excavators, bucket cranes, etc. It is also applicable to machines.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mechanical Engineering (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Operation Control Of Excavators (AREA)

Abstract

La présente invention étalonne avec précision des informations concernant une machine de travail au moyen de tâches simples. Le présent procédé d'étalonnage d'informations comprend : l'arrêt d'une cible de mesure à au moins trois points de mesure différents dans un plan, dans l'ordre ; la mesure de la posture d'une machine de travail par rapport à la carrosserie d'un véhicule lorsque la cible de mesure est arrêtée à chaque point de mesure ; la mesure de la distance entre chacun des points de mesure ; l'obtention d'informations dans lesquelles la différence est minimisée entre les coordonnées de mesure du point de mesure basées sur les distances et dans un système de coordonnées défini dans le plan, et les coordonnées calculées du point de mesure calculées à l'aide de la posture et des informations, ainsi que la mise à jour des informations.
PCT/JP2023/002169 2022-03-04 2023-01-25 Procédé d'étalonnage d'informations WO2023166885A1 (fr)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2022-033522 2022-03-04
JP2022033522A JP2023128874A (ja) 2022-03-04 2022-03-04 情報較正方法

Publications (1)

Publication Number Publication Date
WO2023166885A1 true WO2023166885A1 (fr) 2023-09-07

Family

ID=87883285

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2023/002169 WO2023166885A1 (fr) 2022-03-04 2023-01-25 Procédé d'étalonnage d'informations

Country Status (2)

Country Link
JP (1) JP2023128874A (fr)
WO (1) WO2023166885A1 (fr)

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016056259A1 (fr) * 2014-10-07 2016-04-14 株式会社ログバー Procédé de traitement de données de système d'entrée de gestes
JP2019132038A (ja) * 2018-01-31 2019-08-08 住友重機械工業株式会社 ショベル

Patent Citations (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2016056259A1 (fr) * 2014-10-07 2016-04-14 株式会社ログバー Procédé de traitement de données de système d'entrée de gestes
JP2016076104A (ja) * 2014-10-07 2016-05-12 株式会社ログバー ジェスチャ入力システムのデータ加工方法
JP2019132038A (ja) * 2018-01-31 2019-08-08 住友重機械工業株式会社 ショベル

Also Published As

Publication number Publication date
JP2023128874A (ja) 2023-09-14

Similar Documents

Publication Publication Date Title
KR101733963B1 (ko) 작업 기계의 교정 장치 및 작업 기계의 작업기 파라미터의 교정 방법
JP5823046B1 (ja) 油圧ショベルの較正システム及び較正方法
KR101833603B1 (ko) 작업 기계의 제어 시스템 및 작업 기계
JP5841300B1 (ja) 作業機械の較正装置、及び作業機械の作業機パラメータの較正方法
JP6068730B2 (ja) 作業機械、及び作業機械の作業機パラメータ補正方法
JP5237408B2 (ja) 油圧ショベルの較正システム及び較正方法
US9663917B2 (en) Work vehicle, bucket device, and method for obtaining tilt angle
CN111441401B (zh) 挖土机
CN113494104B (zh) 建设作业机械的定位校正方法及其定位校正控制器
US9404745B2 (en) Measurement jig
KR102479701B1 (ko) 작업 기계
US9689145B1 (en) Work vehicle and method for obtaining tilt angle
WO2018164079A1 (fr) Procédé d'acquisition d'une quantité de correction de capteur d'inclinaison dans un engin de chantier de construction
JP2016224038A (ja) 作業機械の制御システム及び作業機械
WO2022107589A1 (fr) Système et procédé d'acquisition d'informations
JP2020002708A (ja) 作業機械
WO2023166885A1 (fr) Procédé d'étalonnage d'informations
CN117836488A (zh) 用于控制作业机械的系统以及方法
WO2023157744A1 (fr) Système et procédé d'acquisition d'informations
JP7229109B2 (ja) 作業機械および作業機械の制御方法
JP7349956B2 (ja) 施工方法及び施工システム
US20240352702A1 (en) System and method for controlling working machine

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 23763147

Country of ref document: EP

Kind code of ref document: A1