Patent Application
20190292747
The present invention relates to a control system of a construction machine, a construction machine, and a control method of a construction machine.
A construction machine provided with working equipment including a tilt-type bucket as disclosed in Patent Literature 1 is known.
Patent Literature 1: WO 2015/186179 A
In a technical field related to control of the construction machine, a technology of controlling working equipment in preference to an operation of an operation device by an operator of the construction machine is known. In this specification, working equipment control in preference to the operation of the operation device by the operator of the construction machine is referred to as intervention control.
In the intervention control, a position or a posture of at least one of a boom, an arm, and a bucket of the working equipment is controlled with respect to a target construction topography indicating a target shape of an excavation object. The intervention control is performed, and thus construction conforming to the target construction topography is performed.
In the construction machine including the tilt-type bucket, when control specific to the tilt-type bucket is not performed in addition to the existing intervention control, work efficiency of the construction machine deteriorates.
An object of aspects of the invention is to provide a control system of a construction machine which is capable of suppressing deterioration of work efficiency in a construction machine provided with working equipment including a tilt-type bucket, a construction machine, and a control method of a construction machine.
According to a first aspect of the present invention, a control system of a construction machine provided with working equipment including an arm and a bucket configured to rotate around each of a bucket axis and a tilt axis orthogonal to the bucket axis with respect to the arm, the control system comprises: an angle determination unit configured to determine a tilt angle indicating an angle of a specific portion of the bucket around the tilt axis so that a target construction topography indicating a target shape of an excavation object and the specific portion of the bucket become parallel to each other; and a working equipment control unit configured to control a tilt cylinder configured to rotate the bucket around the tilt axis on the basis of the tilt angle determined by the angle determination unit.
According to a second aspect of the present invention, a construction machine, comprises: an upper swing body; a lower travel body configured to support the upper swing body; working equipment that includes the arm and the bucket, the working equipment being configured to be supported to the upper swing body; and the control system of the construction machine according to the first aspect.
According to a third aspect of the present invention, a control method of a construction machine provided with working equipment including an arm and a bucket configured to rotate around each of a bucket axis and a tilt axis orthogonal to the bucket axis with respect to the arm, the control method comprises: determining a tilt angle indicating an angle of a specific portion of the bucket around the tilt axis so that a target construction topography indicating a target shape of an excavation object and the specific portion of the bucket become parallel to each other; and controlling a tilt cylinder configured to rotate the bucket around the tilt axis on the basis of the tilt angle determined by the angle determination unit.
According to the aspects of the invention, a control system of a construction machine which is capable of suppressing deterioration of work efficiency in a construction machine provided with working equipment including a tilt-type bucket, a construction machine, and a control method of a construction machine are provided.
Hereinafter, embodiments according to the invention will be described with reference to the accompanying drawings, but the invention is not limited thereto. Constituent elements of the following respective embodiments can be appropriately combined with each other. In addition, partial constituent elements may not be used.
In the following description, a positional relationship of respective portions will be described by specifying a three-dimensional global coordinate system (Xg, Yg, and Zg), and a three-dimensional vehicle body coordinate system (Xm, Ym, and Zm).
The global coordinate system represents a coordinate system in which the original point fixed to the globe is set as a reference. The global coordinate system is a coordinate system that is defined by a global navigation satellite system (GNSS). The GNSS represents a global navigation satellite system. As an example of the global navigation satellite system, a global positioning system (GPS) can be exemplified. The GNSS includes a plurality of positioning satellites. The GNSS detects a position that is defined by coordinate data of a latitude, a longitude, and altitude.
The global coordinate system is defined by an Xg axis in a horizontal plane, a Yg axis that is orthogonal to the Xg axis in the horizontal plane, and a Zg axis that is orthogonal to the Xg axis and the Yg axis. A direction parallel to the Xg axis is set as an Xg axis direction, a direction parallel to the Yg axis is set as a Yg axis direction, and a direction parallel to the Zg axis is set as a Zg axis direction. In addition, a rotation or inclination direction around the Xg axis is set as a θXg direction, a rotation or inclination direction around the Yg axis is set as a θYg direction, and a rotation or inclination direction around the Zg axis is set as a θZg direction. The Zg axis direction is a vertical direction.
The vehicle body coordinate system represents a coordinate system in which the original point fixed to construction machine is set as a reference.
The vehicle body coordinate system is defined by an Xm axis that extends in one direction with the original point fixed to a vehicle body of a construction machine set as a reference, a Ym axis that is orthogonal to the Xm axis, a Zm axis that is orthogonal to the Xm axis and the Ym axis. A direction parallel to the Xm axis is set as an Xm axis direction, a direction parallel to the Ym axis is set as a Ym axis direction, and a direction parallel to the Zm axis is set as a Zm axis direction. In addition, a rotation or inclination direction around the Xm axis is set as a θXm direction, a rotation or inclination direction around the Ym axis is set as a θYm direction, and a rotation or inclination direction around the Zm axis is set as a θZm direction. The Xm axis direction is a front and back direction of the construction machine, the Ym axis direction is a vehicle width direction of the construction machine, and the Zm axis direction is an upper and lower direction of the construction machine.
[Construction Machine]
As illustrated in
The upper swing body 2 includes a driving chamber 4 in which an operator rides, and a machine chamber 5 in which an engine and a hydraulic pump are accommodated. The driving chamber 4 includes a driver's seat 4S on which the operator sits. The machine chamber 5 is disposed on a rearward side of the driving chamber 4.
The lower travel body 3 includes a pair of crawlers 3C. The excavator 100 travels due to rotation of the crawlers 3C. Furthermore, the lower travel body 3 may include tires.
The working equipment 1 is supported to the upper swing body 2. The working equipment 1 includes a boom 6 that is connected to the upper swing body 2 through a boom pin, an arm 7 that is connected to the boom 6 through an arm pin, and a bucket 8 that is connected to the arm 7 through a bucket pin and a tilt pin. The bucket 8 includes a blade edge 9. In this embodiment, the blade edge 9 of the bucket 8 is a tip end of a straight blade provided in the bucket 8. Furthermore, the blade edge 9 of the bucket 8 may be a tip end of a convex blade provided in the bucket 8.
The boom 6 can rotate around a boom axis AX1 that is a rotation axis with respect to the upper swing body 2. The arm 7 can rotate around an arm axis AX2 that is a rotation axis with respect to the boom 6. The bucket 8 can rotate around a bucket axis AX3 that is a rotation axis and a tilt axis AX4 that is a rotation axis orthogonal to the bucket axis AX3 with respect to the arm 7. The rotation axis AX1, the rotation axis AX2, and the rotation axis AX3 are parallel to each other. The rotation axes AX1, AX2, and AX3, and an axis parallel to the swing axis RX are orthogonal to each other. The rotation axes AX1, AX2, and AX3 are parallel to the Ym axis of the vehicle body coordinate system. The swing axis RX is parallel to the Zm axis of the vehicle body coordinate system. A direction parallel to the rotation axes AX1, AX2, and AX3 represents a vehicle width direction of the upper swing body 2. A direction parallel to the swing axis RX represents an upper and lower direction of the upper swing body 2. A direction orthogonal to both the rotation axes AX1, AX2, and AX3, and the swing axis RX represents a front and back direction of the upper swing body 2. A direction in which the working equipment 1 exists on the basis of the operator who sits on the driver's seat 4S is a forward side.
The working equipment 1 operates by the power generated by a hydraulic cylinder 10. The hydraulic cylinder 10 includes a boom cylinder 11 that operates the boom 6, an arm cylinder 12 that operates the arm 7, and a bucket cylinder 13 and a tilt cylinder 14 which operate the bucket 8. The boom cylinder 11 can generate power for rotating the boom 6 around the boom axis AX1. The arm cylinder 12 can generate power for rotating the arm 7 around an arm axis AX2. The bucket cylinder 13 can generate power for rotating the bucket 8 around a bucket axis AX3. The tilt cylinder 14 can generate power for rotating the bucket 8 around a tilt axis AX4.
In the following description, rotation of the bucket 8 around the bucket axis AX3 is appropriately referred to as bucket rotation, and rotation of the bucket 8 around the tilt axis AX4 is appropriately referred to as tilt rotation.
In addition, the working equipment 1 includes a boom stroke sensor 16 that detects a boom stroke indicating the amount of driving of the boom cylinder 11, an arm stroke sensor 17 that detects an arm stroke indicating the amount of driving of the arm cylinder 12, a bucket stroke sensor 18 that detects a bucket stroke indicating the amount of the driving of the bucket cylinder 13, and a tilt stroke sensor 19 that detects a tilt stroke indicating the amount of driving of the tilt cylinder 14. The boom stroke sensor 16 is disposed at the boom cylinder 11. The arm stroke sensor 17 is disposed at the arm cylinder 12. The bucket stroke sensor 18 is disposed at the bucket cylinder 13. The tilt stroke sensor 19 is disposed at the tilt cylinder 14.
The operation device 30 is disposed in the driving chamber 4. The operation device 30 includes an operation member that is operated by an operator of the excavator 100. The operator operates the working equipment 1 by operating the operation device 30. In this embodiment, the operation device 30 includes a right working equipment operation lever 30R, a left working equipment operation lever 30L, a tilt operation lever 30T, and an operation pedal 30F.
When the right working equipment operation lever 30R located at the neutral position is operated to a forward side, the boom 6 operates downward, and when the right working equipment operation lever 30R is operated to a backward side, the boom 6 operates upward. When the right working equipment operation lever 30R located at the neutral position is operated to a right side, the bucket 8 performs dumping, and when the right working equipment operation lever 30R is operated to a left side, the bucket 8 performs excavation.
When the left working equipment operation lever 30L located at the neutral position is operated to a forward side, the arm 7 performs dumping, and when the left working equipment operation lever 30L is operated to a backward side, the arm 7 performs excavation. When the left working equipment operation lever 30L located at the neutral position is operated to a right side, the upper swing body 2 swings to the right, and when the left working equipment operation lever 30L is operated to a left side, the upper swing body 2 swings to the left.
Furthermore, the relationship between the operation direction of the right working equipment operation lever 30R and the left working equipment operation lever 30L, and the operation direction of the working equipment 1 and the swing direction of the upper swing body 2 may not be the above-described relationship.
The control device 50 includes a computer system. The control device 50 includes a processor such as a central processing unit (CPU), a storage device including a non-volatile memory such as a read only memory (ROM), and a volatile memory such as a random access memory (RAM), and an input/output interface device.
[Bucket]
Next, the bucket 8 according to this embodiment will be described.
As illustrated in
The bucket 8 is connected to a tip end of the arm 7 through a connection member 90. The bucket pin 8B connects the arm 7 and the connection member 90 to each other. The tilt pin 8T connects the connection member 90 and the bucket 8 to each other. The bucket 8 is rotatably connected to the arm 7 through the connection member 90.
The bucket 8 includes a bottom plate 81, a rear plate 82, an upper plate 83, a side plate 84, and a side plate 85. An opening 86 of the bucket 8 is defined by the bottom plate 81, the upper plate 83, the side plate 84, and the side plate 85. The blade edge 9 is provided in the bottom plate 81. The bottom plate 81 includes a flat floor surface 89 that is connected to the blade edge 9. The floor surface 89 is a bottom surface of the bottom plate 81. The floor surface 89 is a substantially flat surface.
The bucket 8 includes a bracket 87 that is provided in an upper portion of the upper plate 83. The bracket 87 is provided at front and back positions of the upper plate 83. The bracket 87 is connected to the connection member 90 and the tilt pin 8T.
The connection member 90 includes a plate member 91, a bracket 92 that is provided on an upper surface of the plate member 91, and a bracket 93 that is provided on a lower surface of the plate member 91. The bracket 92 is connected to the arm 7 and a second link pin 95P. The bracket 93 is provided in an upper portion of the bracket 87, and is connected to the tilt pin 8T and the bracket 87.
The bucket pin 8B connects the bracket 92 of the connection member 90 and the tip end of the arm 7 to each other. The tilt pin 8T connects the bracket 93 of the connection member 90 and the bracket 87 of the bucket 8. The connection member 90 and the bucket 8 can rotate around the bucket axis AX3 with respect to the arm 7. The bucket 8 can rotate around the tilt axis AX4 with respect to the connection member 90.
The working equipment 1 includes a first link member 94 that is rotatably connected to the arm 7 through a first link pin 94P, and a second link member 95 that is rotatably connected to the bracket 92 through the second link pin 95P. A base end of the first link member 94 is connected to the arm 7 through the first link pin 94P. A base end of the second link member 95 is connected to the bracket 92 through the second link pin 95P. A tip end of the first link member 94 and a tip end of the second link member 95 are connected to each other through a bucket cylinder top pin 96.
A tip end of the bucket cylinder 13 is rotatably connected to the tip end of the first link member 94 and the tip end of the second link member 95 through the bucket cylinder top pin 96. When the bucket cylinder 13 operates to expand and contract, the connection member 90 rotates around the bucket axis AX3 in combination with the bucket 8.
The tilt cylinder 14 is connected to a bracket 97 that is provided in the connection member 90, and a bracket 88 that is provided in the bucket 8. A rod of the tilt cylinder 14 is connected to the bracket 97 through a pin. A main body portion of the tilt cylinder 14 is connected to the bracket 88 through a pin. When the tilt cylinder 14 operates to expand and contract, the bucket 8 rotates around the tilt axis AX4. Furthermore, the connection structure of the tilt cylinder 14 according to this embodiment is illustrative only, and there is no limitation thereto.
As described above, the bucket 8 rotates around the bucket axis AX3 due to an operation of the bucket cylinder 13. The bucket 8 rotates around the tilt axis AX4 due to an operation of the tilt cylinder 14. When the bucket 8 rotates around the bucket axis AX3, the tilt pin 8T rotates in combination with the bucket 8.
[Detection System]
Next, a detection system 400 of the excavator 100 according to this embodiment will be described.
As illustrated in
The position calculation device 20 includes a vehicle body position calculator 21 that detects a position of the upper swing body 2, a posture calculator 22 that detects a posture of the upper swing body 2, and an azimuth calculator 23 that detects an azimuth of the upper swing body 2.
The vehicle body position calculator 21 includes a GPS receiver. The vehicle body position calculator 21 is provided in the upper swing body 2. The vehicle body position calculator 21 detects an absolute position Pg of the upper swing body 2 which is defined by the global coordinate system. The absolute position Pg of the upper swing body 2 includes coordinate data in the Xg axis direction, coordinate data in the Yg axis direction, and coordinate data in the Zg axis direction.
A plurality of GPS antennas 21A are provided in the upper swing body 2. Each of the GPS antennas 21A receives electric waves from a GPS satellite, and outputs a signal generated on the basis of the received electric waves to the vehicle body position calculator 21. The vehicle body position calculator 21 detects a position Pr, at which the GPS antenna 21A is provided, defined by the global coordinate system on the basis of the signal supplied from the GPS antenna 21A. The vehicle body position calculator 21 detects the absolute position Pg of the upper swing body 2 on the basis of the position Pr at which the GPS antenna 21A is provided.
Two pieces of the GPS antenna 21A are provided in a vehicle width direction. The vehicle body position calculator 21 detects a position Pra at which the one of the GPS antennas 21A is provided, and a position Prb at which the other GPS antenna 21A is provided. The vehicle body position calculator 21A performs calculation processing on the basis of at least one of the position Pra and the position Prb, and calculates the absolute position Pg of the upper swing body 2. In this embodiment, the absolute position Pg of the upper swing body 2 is the position Pra. Furthermore, the absolute position Pg of the upper swing body 2 may be the position Prb, or may be a position between the position Pra and the position Prb.
The posture calculator 22 includes an inertial measurement unit (IMU). The posture calculator 22 is provided in the upper swing body 2. The posture calculator 22 calculates an inclination angle of the upper swing body 2 with respect to a horizontal plane (XgYg plane) which is defined by the global coordinate system. The inclination angle of the upper swing body 2 with respect to the horizontal plane includes a roll angle θ1 indicating an inclination angle of the upper swing body 2 in the vehicle width direction, and a pitch angle θ2 indicating an inclination angle of the upper swing body 2 in the front and back direction.
The azimuth calculator 23 calculates an azimuth of the upper swing body 2 with respect to a reference azimuth which is defined by the global coordinate system on the basis of the position Pra at which the one GPS antenna 21A is provided and the position Prb at which the other GPS antenna 21A is provided. For example, the reference azimuth is the north. The azimuth calculator 23 performs calculation processing on the basis of the position Pra and the position Prb, and calculates the azimuth of the upper swing body 2 with respect to the reference azimuth. The azimuth calculator 23 calculates a straight line connecting the position Pra and the position Prb, and calculates the azimuth of the upper swing body 2 with respect to the reference azimuth on the basis of an angle made between the calculated straight line and the reference azimuth. The azimuth of the upper swing body 2 with respect to the reference azimuth includes a yaw angle θ3 indicating an angle made between the reference azimuth and the azimuth of the upper swing body 2.
As illustrated in
Furthermore, the boom angle α, the arm angle β, the bucket angle γ, the tilt angle δ, and the tilt axis angle ε may be detected by, for example, angle sensors which are provided in the working equipment 10 without using the stroke sensors. In addition, the angle of the working equipment 10 may be optically detected with a stereo camera or a laser scanner, and the boom angle α, the arm angle β, the bucket angle γ, the tilt angle δ, and the tilt axis angle ε may be calculated by using the detection result.
[Hydraulic System]
Next, an example of a hydraulic system 300 of the excavator 100 according to this embodiment will be described.
The hydraulic oil supplied from the main hydraulic pump 31 is supplied to the arm cylinder 12 through the flow rate control valve 25. The flow rate control valve 25 is a slide spool type flow rate control valve that switches a flow direction of the hydraulic oil by moving a rod-shaped spool in an axial direction. When the spool is moved in the axial direction, supply of the hydraulic oil to the cap side oil chamber 10A of the arm cylinder 12 and supply of the hydraulic oil to the rod side oil chamber 10B are switched from each other. In addition, when the spool is moved in the axial direction, the supply amount of the hydraulic oil per unit time with respect to the arm cylinder 12 is adjusted. When the supply amount of the hydraulic oil with respect to the arm cylinder 12 is adjusted, a cylinder speed is adjusted.
The flow rate control valve 25 is operated by the operation device 30. The pilot oil sent from the pilot pressure pump 32 is supplied to the operation device 30. Furthermore, a pilot oil, which is sent from the main hydraulic pump 31 and of which a pressure is reduced by a pressure reduction valve, may be supplied to the operation device 30. The operation device 30 includes a pilot pressure adjustment valve. The control valves 37A and 37B are operated on the basis of an operation amount of the operation device 30, and a pilot pressure that acts on the spool of the flow rate control valve 25 is adjusted. The flow rate control valve 25 is driven by the pilot pressure. When the pilot pressure is adjusted by the operation device 30, the amount of movement, a movement speed, and a movement direction of the spool in an axial direction are adjusted.
The flow rate control valve 25 includes a first pressure-receiving chamber and a second pressure-receiving chamber. When the left working equipment operation lever 30L is operated to be tilted to one side in comparison to a neutral position, and the spool is moved by the pilot pressure of the oil path 33A, the hydraulic oil from the main hydraulic pump 31 is supplied to the first pressure-receiving chamber, and the hydraulic oil is supplied to the cap side oil chamber 10A through the oil path 35A. When the left working equipment operation lever 30L is operated to be tilted to the other side in comparison to the neutral position, and the spool is moved by the pilot pressure of the oil path 33B, the hydraulic oil from the main hydraulic pump 31 is supplied to the second pressure-receiving chamber, and the hydraulic oil is supplied to the rod side oil chamber 10B through the oil path 35B.
The pressure sensor 34A detects a pilot pressure of the oil path 33A. The pressure sensor 34B detects a pilot pressure of the oil path 33B. A detection signal of the pressure sensor 33A or 33B is output to the control device 50. When performing intervention control, the control device 50 outputs a control signal to the control valve 37A or 37B to adjust the pilot pressure.
A hydraulic system 300 that operates the boom cylinder 11 and the bucket cylinder 13 has the same configuration as that of the hydraulic system 300 that operates the arm cylinder 12. Detailed description of the hydraulic system 300 that operates the boom cylinder 11 and the bucket cylinder 13 will be omitted. Furthermore, an intervention control valve that intervenes in a lifting operation of the boom 6 may be connected to the oil path 33A that is connected to the boom cylinder 11 to perform intervention control with respect to the boom 6.
Furthermore, the right working equipment operation lever 30R and the left working equipment operation lever 30L of the operation device 30 may not be the pilot hydraulic type. The right working equipment operation lever 30R and the left working equipment operation lever 30L may be an electronic lever type that outputs an electric signal to the control device 50 on the basis of an operation amount (a tilt angle) of the right working equipment operation lever 30R and the left working equipment operation lever 30L, and directly controls the flow rate control valve 25 on the basis of a control signal of the control device 50.
The operation pedal 30F of the operation device 30 is connected to the pilot pressure pump 32. In addition, the operation pedal 30F is connected to an oil path 38A, through which a pilot oil sent from the control valve 37A flows, through a shuttle valve 36A. In addition, the operation pedal 30F is connected to an oil path 38B, through which a pilot oil sent from the control valve 37B flows, through a shuttle valve 36B. When the operation pedal 30F is operated, a pressure of an oil path 33A between the operation pedal 30F and the shuttle valve 36A, and a pressure of an oil path 33B between the operation pedal 30F and the shuttle valve 36B are adjusted.
When the tilt operation lever 30T is operated, an operation signal generated by the operation of the tilt operation lever 30T is output to the control device 50. The control device 50 generates a control signal on the basis of the operation signal output from the tilt operation lever 30T to control the control valves 37A and 37B. The control valves 37A and 37B are electromagnetic proportional control valves. The control valve 37A opens and closes the oil path 38A on the basis of the control signal. The control valve 37B opens and closes the oil path 38B on the basis of the control signal.
When not performing the intervention control with respect to tilt rotation of the bucket 8, the pilot pressure is adjusted on the basis of an operation amount of the operation device 30. When performing the intervention control with respect to the tilt rotation of the bucket 8, the control device 50 outputs the control signal to the control valve 37A or 37B to adjust the pilot pressure.
[Control System]
Next, a control system 200 of the excavator 100 according to this embodiment will be described.
As illustrated in
The position calculation device 20 includes a vehicle body position calculator 21, a posture calculator 22, and an azimuth calculator 23. The position calculation device 20 detects the absolute position Pg of the upper swing body 2, the posture of the upper swing body 2 which includes the roll angle θ1 and the pitch angle θ2, and the azimuth of the upper swing body 2 which includes the yaw angle θ3.
The working equipment angle calculation device 24 detects the angle of the working equipment 1 which includes the boom angle α, the arm angle β, the bucket angle γ, the tilt angle δ, and the tilt axis angle ε.
The control valves 37 (37A and 37B) adjust the amount of the hydraulic oil supplied to the tilt cylinder 14. The control valves 37 operate on the basis of the control signal from the control device 50.
The target construction data generation device 70 includes a computer system. The target construction data generation device 70 generates target construction data indicating a target topography that is a target shape of a construction area. The target construction data indicates a three-dimensional target shape that is obtained after construction by the working equipment 1.
The target construction data generation device 70 is provided at a remote location of the excavator 100. For example, the target construction data generation device 70 is provided in a facility of a construction management company. Furthermore, the target construction data generation device 70 may be possessed by a manufacturing company or a rental company of the excavator 100. The target construction data generation device 70 and the control device 50 can perform wireless communication. The target construction data generated by the target construction data generation device 70 is wirelessly transmitted to the control device 50.
Furthermore, the target construction data generation device 70 and the control device 50 may be connected with a wire, and the target construction data may be transmitted from the target construction data generation device 70 to the control device 50. Furthermore, the target construction data generation device 70 may include a recording medium that stores the target construction data, and the control device 50 may include a device that can scan the target construction data from the recording medium.
Furthermore, the target construction data generation device 70 may be provided in the excavator 100. The target construction data may be supplied from an external management device that manages construction to the target construction data generation device 70 of the excavator 100 in a wired or wireless manner, and the target construction data generation device 70 may store the target construction data that is supplied.
The control device 50 includes a vehicle body position data acquisition unit 51, a working equipment angle data acquisition unit 52, a specified point position data calculation unit 53, a target construction topography generation unit 54, a tilt data calculation unit 55, a tilt target topography calculation unit 56, an angle determination unit 57, a working equipment control unit 58, a target speed determination unit 59, a storage unit 60, and an input/output unit 61.
Respective functions of the vehicle body position data acquisition unit 51, the working equipment angle data acquisition unit 52, the specified point position data calculation unit 53, the target construction topography generation unit 54, the tilt data calculation unit 55, the tilt target topography calculation unit 56, the angle determination unit 57, the working equipment control unit 58, and the target speed determination unit 59 are exhibited by a processor of the control device 50. A function of the storage unit 60 is exhibited by the storage device of the control device 50. A function of the input/output unit 61 is exhibited by the input/output interface device of the control device 50. The input/output unit 61 is connected to the position calculation device 20, the working equipment angle calculation device 24, the control valves 37, and the target construction data generation device 70, and performs data communication with the vehicle body position data acquisition unit 51, the working equipment angle data acquisition unit 52, the specified point position data calculation unit 53, the target construction topography generation unit 54, the tilt data calculation unit 55, the tilt target topography calculation unit 56, the angle determination unit 57, the working equipment control unit 58, the target speed determination unit 59, and the storage unit 60.
The storage unit 60 stores parameter data of the excavator 100 which includes the working equipment data.
The vehicle body position data acquisition unit 51 acquires vehicle body position data from the position calculation device 20 through the input/output unit 61. The vehicle body position data includes the absolute position Pg of the upper swing body 2 which is defined by the global coordinate system, the posture of the upper swing body 2 which includes the roll angle θ1 and the pitch angle θ2, and the azimuth of the upper swing body 2 which includes the yaw angle θ3.
The working equipment angle data acquisition unit 52 acquires the working equipment angle data from the working equipment angle calculation device 24 through the input/output unit 61. The working equipment angle data detects an angle of the working equipment 1 which includes the boom angle α, the arm angle β, the bucket angle γ, the tilt angle δ, and the tilt axis angle E.
The specified point position data calculation unit 53 calculates position data of specified point RP that is set to the bucket 8 on the basis of the vehicle body position data acquired by the vehicle body position data acquisition unit 51, the working equipment angle data acquired by the working equipment angle data acquisition unit 52, and the working equipment data stored in the storage unit 60.
As illustrated in
In addition, the working equipment data includes bucket outer shape data indicating a shape and dimensions of the bucket 8. The bucket outer shape data includes width data of the bucket 8 which indicates the bucket width L5. In addition, the bucket outer shape data includes outer surface data of the bucket 8 which includes contour data of the outer surface of the bucket 8. In addition, the bucket outer shape data includes coordinate data of the plurality of specified points RP of the bucket 8 with the blade edge 9 of the bucket 8 set as a reference.
The specified point position data calculation unit 53 calculates position data of the specified points RP. The specified point position data calculation unit 53 calculates a relative position of each of the plurality of specified points RP with respect to a reference position P0 of the upper swing body 2 in the vehicle body coordinate system. In addition, the specified point position data calculation unit 53 calculates an absolute position of each of the plurality of specified points RP in the global coordinate system.
The specified point position data calculation unit 53 can calculate a relative position of each of the plurality of specified points RP of the bucket 8 with respect to the reference position P0 of the upper swing body 2 in the vehicle body coordinate system on the basis of the working equipment data that includes the boom length L1, the arm length L2, the bucket length L3, the tilt length L4, and the bucket outer shape data, and the working equipment angle data that includes the boom angle α, the arm angle β, the bucket angle γ, the tilt angle δ, and the tilt axis angle ε. As illustrated in
In addition, the specified point position data calculation unit 53 can calculate the absolute position Pa of the bucket 8 in the global coordinate system on the basis of the absolute position Pg of the upper swing body 2 which is detected by the position calculation device 20, and a relative position between the reference position P0 of the upper swing body 2 and the bucket 8. The absolute position Pg and the relative position with the reference position P0 are known data that is derived from parameter data of the excavator 100. The specified point position data calculation unit 53 can calculate an absolute position of each of the plurality of specified points RP of the bucket 8 in the global coordinate system on the basis of the vehicle body position data including the absolute position Pg of the upper swing body 2, the relative position between the reference position P0 of the upper swing body 2 and the bucket 8, the working equipment data, and the working equipment angle data.
The target construction topography generation unit 54 generates a target construction topography CS indicating a target shape of an excavation object on the basis of the target construction data that is supplied from the target construction data generation device 70 and is stored in the storage unit 60. The target construction data generation device 70 may supply three-dimensional topography data to the target construction topography generation unit 54, or may supply a plurality of pieces of line data or a plurality of pieces of point data which indicate a part of the target shape to the target construction topography generation unit 54 as the target construction data. In this embodiment, it is assumed that the target construction data generation device 70 supplies line data indicating a part of the target shape to the target construction topography generation unit 54 as the target construction data.
The target construction topography generation unit 54 acquires a line LX that is an intersecting line between the working equipment operation plane WP and the target construction topography CS. In addition, the target construction topography generation unit 54 acquires a line LY that passes through the point AP and is orthogonal to the line LX in the target construction topography CS. The line LY represents an intersecting line between a lateral operation plane VP and the target construction topography CS. The lateral operation plane VP is a plane that is orthogonal to the working equipment operation plane WP and passes through the point AP.
The tilt data calculation unit 55 calculates a tilt operation plane TP that passes through the specified point RP of the bucket 8 and is orthogonal to the tilt axis AX4 as tilt data.
As illustrated in
As described above, the working equipment angle calculation device 24 can calculate the tilt axis angle ε indicating the inclination angle of the tilt axis AX4 with respect to the XY plane. The tilt axis angle ε is acquired by the working equipment angle data acquisition unit 52. In addition, position data of the specified point RPr is calculated by the specified point position data calculation unit 53. The tilt data calculation unit 55 can calculate the tilt operation plane TP on the basis of the tilt axis angle ε of the tilt axis AX4 which is acquired by the working equipment angle data acquisition unit 52, and the position of the specified point RPr which is calculated by the specified point position data calculation unit 53.
The tilt target topography calculation unit 56 calculates a tilt target topography ST that extends in a lateral direction of the bucket 8 in the target construction topography CS on the basis of the position data of the specified point RPr selected from the plurality of specified points RP, the target construction topography CS, and the tilt data. The tilt target topography calculation unit 56 calculates the tilt target topography ST that is specified by an intersection between the target construction topography CS and the tilt operation plane TP. As illustrated in
The angle determination unit 57 determines the tilt angle δ indicating an angle of a specific portion of the bucket 8 around the tilt axis AX4 so that the target construction topography CS and the specific portion of the bucket 8 become parallel to each other. In this embodiment, the specific portion of the bucket 8 is the blade edge 9 of the bucket 8.
In this embodiment, the angle determination unit 57 determines the tilt angle δr of the blade edge of the bucket 8 so that the tilt target topography ST becomes parallel to the blade edge 9 of the bucket 8.
The working equipment control unit 58 outputs a control signal for controlling the hydraulic cylinder 10. The working equipment control unit 58 controls the tilt cylinder 14 so that the target construction topography CS and the blade edge 9 of the bucket 8 become parallel to each other on the basis of the tilt angle δr determined by the angle determination unit 57.
In addition, the working equipment control unit 58 stops the tilt rotation of the bucket 8 around the tilt axis AX4 so that the bucket 8 does not exceed the target construction topography CS on the basis of an operation distance Da indicating a distance between the specified point RPr of the bucket 8 and the tilt target topography ST. That is, the working equipment control unit 58 stops the bucket 8 in the tilt target topography ST so that the bucket 8 that tilt-rotates does not exceed the tilt target topography ST.
As illustrated in
The working equipment control unit 58 performs the intervention control related to the tilt rotation on the basis of the specified point RPr at which the operation distance Da is shortest among the plurality of specified points RP set to the bucket 8. That is, the working equipment control unit 58 performs the intervention control related to the tilt rotation on the basis of the specified point RPr closest to the tilt target topography ST, the tilt target topography ST, and the operation distance Da so that the specified point RPr closest to the tilt target topography ST among the plurality of specified points RP set to the bucket 8 does not exceed the tilt target topography ST.
The target speed determination unit 59 determines a target speed U related to a tilt rotation speed of the bucket 8 on the basis of the operation distance Da. When the operation distance Da is equal to or shorter than a line distance H that is a threshold value, the target speed determination unit 59 limits the tilt rotation speed.
The target speed determination unit 59 acquires the operation distance Da between the specified point RPr and the tilt target topography ST in a direction parallel to the tilt operation plane TP. In addition, the target speed determination unit 59 acquires the target speed U corresponding to the operation distance Da. In a case where it is determined that the operation distance Da is equal to or shorter than the line distance H, the working equipment control unit 58 limits the tilt rotation speed.
The target speed determination unit 59 calculates a movement speed Vr when the specified point RP moves toward the target construction topography CS (tilt target topography ST) on the basis of the operation amount of the tilt operation lever 30T of the operation device 30. The movement speed Vr is a movement speed of the specified point RPr in a plane parallel to the tilt operation plane TP. The movement speed Vr is calculated with respect to each of the plurality of specified points RP.
In this embodiment, in a case where the tilt operation lever 30T is operated, the movement speed Vr is calculated on the basis of a current value output from the tilt operation lever 30T. When the tilt operation lever 30T is operated, a current corresponding to an operation amount of the tilt operation lever 30T is output from the tilt operation lever 30T. The storage unit 60 can store a cylinder speed of the tilt cylinder 14 corresponding to the operation amount of the tilt operation lever 30T. Furthermore, the cylinder speed may be obtained through detection by a cylinder stroke sensor. After the cylinder speed of the tilt cylinder 14 is calculated, the target speed determination unit 59 converts the cylinder speed of the tilt cylinder 14 into the movement speed Vr of each of the plurality of specified point RP of the bucket 8 by using a Jacobian determinant.
In a case where it is determined that the operation distance Da is equal to or shorter than the line distance H, the working equipment control unit 58 performs speed limitation that limits the movement speed Vr of the specified point RPr with respect to the target construction topography CS to the target speed U. The working equipment control unit 58 outputs a control signal to the control valves 37 to suppress the movement speed Vr of the specified point RPr of the bucket 8. The working equipment control unit 58 outputs a control signal to the control valves 37 so that the movement speed Vr of the specified point RPr of the bucket 8 becomes the target speed U corresponding to the operation distance Da. According to this, the movement speed RP of the specified point RPr of the bucket 8 that tilt-rotates becomes slower as the specified point RPr approaches the target construction topography CS (tilt target topography ST), and becomes 0 when the specified point RPr (blade edge 9) reaches the target construction topography CD.
[Angle Adjustment Method]
Next, a method of adjusting the tilt angle δ of the bucket 8 according to this embodiment will be described.
The specified point position data calculation unit 53 calculates position data of a specified point RPa that is specified to the blade edge 9, and position data of a specified point RPb that is specified to the blade edge 9 (Step SA10).
As illustrated in
In addition, the specified point position data calculation unit 53 calculates a direction vector Vec_ab that connects the specified point RPa and the specified point RPb on the basis of the position data of the specified point RPa and the position data of the specified point RPb. The direction vector Vec_ab is defined by the following Expression (1).
Vec_ab=RPb−RPa (1)
The target construction topography generation unit 54 calculates a normal vector Nd of the target construction topography CS (Step SA20).
The angle determination unit 57 calculates an intersection vector STr between the tilt operation plane TP and the target construction topography CS (Step SA30).
The angle determination unit 57 calculates the tilt angle δr of the blade edge 9 of the bucket 8 for making the blade edge 9 of the bucket 8 and the target construction topography CS parallel to each other (Step SA40).
In this embodiment, the angle determination unit 57 performs calculation processing of the following Expression (2) to calculate the tilt angle δr.
The working equipment control unit 58 controls the tilt cylinder 14 so that the target construction topography CS and the blade edge 9 of the bucket 8 become parallel to each other on the basis of the tilt angle δr determined by the angle determination unit 57 (Step SA50).
[Effects]
As described above, according to this embodiment, in the tilt type bucket, the tilt angle δr of the blade edge 9 of the bucket 8 around the tilt axis AX4 is determined in the angle determination unit 57 so that the target construction topography CS and the blade edge 9 of the bucket 8 become parallel to each other on the basis of a relative angle of the blade edge 9 of the bucket 8 with respect to the target construction topography CS. The working equipment control unit 58 controls the tilt cylinder 14 that rotates the bucket 8 around the tilt axis AX4 on the basis of the tilt angle δr that is determined by the angle determination unit 57. According to this, it is possible to make the blade edge 9 of the bucket 8 and the target construction topography CS parallel to each other in the tilt rotation direction. Accordingly, an operation burden on an operator of the excavator 1 is reduced in construction, and a high-quality construction result that does not depend on the degree of skill of the operator is obtained.
A second embodiment will be described. In the following description, the same reference numeral will be given to the same constituent elements or equivalent constituent elements, and description thereof will be simplified or omitted.
As illustrated in
In this embodiment, description will be given of an example in which the working equipment control unit 58 controls at least one of the tilt cylinder 14 and the bucket cylinder 13 so that parallelism between at least one of the blade edge 9 of the bucket 8 and the floor surface 89 and the target construction topography CS is maintained in a state in which the arm 7 operates.
In the following description, the blade edge 9 and the floor surface 89 of the bucket 8 are appropriately referred to as a specific portion of the bucket 8 in a collective manner.
The specified point position data calculation unit 53 calculates position data of a specified point RPa specified to the blade edge 9, position data of a specified point RPb that is specified to the blade edge 9, and position data of a specified point RPc that is specified to the floor surface 89 (Step SB10).
As illustrated in
As illustrated in
In addition, the specified point position data calculation unit 53 calculates a direction vector Vec_ab that connects the specified point RPa and the specified point RPb on the basis of the position data of the specified point RPa and the position data of the specified point RPb.
In addition, the specified point position data calculation unit 53 calculates a direction vector Vec_ac that connects the specified point RPa and the specified point RPc on the basis of the position data of the specified point RPa and the position data of the specified point RPc.
In addition, the specified point position data calculation unit 53 calculates a normal vector Vec_tilt of the tilt axis AX4.
The angle determination unit 57 calculates a target normal vector Nref of the specific portion of the bucket 8 which is parallel to the target construction topography CS (Step SB20).
For example, in a case where the target construction topography CS and the blade edge 9 of the bucket 8 are made to be parallel to each other, as illustrated in
In addition, in a case of making the target construction topography CS and the floor surface 89 of the bucket 8 parallel to each other, as illustrated in
The direction vector Vec_ab is specified by Expression (1) described above. The direction vector Vec_ac is specified by the following Expression (3).
Vec_ac=RPc−RPa (3)
The target normal vector Nref of the blade edge 9 of the bucket 8 is specified by the following Expression (4).
Nref(blade edge)=Vec_ab×Vec_tilt (4)
The target normal vector Nref of the floor surface 89 of the bucket 8 is specified by the following Expression (5).
Nref(floor surface)=Vec_ac×Vec_ab (5)
The target construction topography generation unit 54 calculates a normal vector Nd of the target construction topography CS (Step SB30).
The angle detection unit 57 calculates an evaluation function Q (Step SB40).
The evaluation function Q is the sum of an evaluation function Q1 indicating a parallelism error between the target normal vector Nref and the normal vector Nd, and an evaluation function Q2 indicating a distance Da between the blade edge 9 and the target construction topography CS. That is, the following Expressions (6), (7), and (8) are established.
Q1=1−Nref·Nd (6)
Q2=Da (7)
Q=Q1+Q2 (8)
In Expression (6), a condition in which the target normal vector Nref and the normal vector Nd become parallel to each other is a state in which an inner product thereof becomes 1. That is, the following Expression (9) is established.
Nref·Nd=1 (9)
Furthermore, in Expression (8), in a case where it is not necessary to bring the bucket 8 into contact with the target construction topography CS, Q may be Q1.
The angle detection unit 57 performs calculation processing by a predetermined numerical value calculation method so that the evaluation function Q of (8) becomes minimum. For example, in the calculation processing, a Newton method, a Powel method, a simplex method, and the like can be used.
The angle detection unit 57 determines whether or not the evaluation function Q becomes minimum (Step SB50). That is, the angle detection unit 57 performs calculation processing by a predetermined numeric operation method, and determines whether or not the evaluation function becomes substantially 0.
In Step SB50, in a case where it is determined that the evaluation function Q is minimum (Step SB50: Yes), the angle detection unit 57 calculates a tilt angle δr and a bucket angle γr of the specific portion of the bucket 8 for making the specific portion of the bucket 8 and the target construction topography CS parallel to each other (Step SB60). That is, the angle detection unit 57 determines the tilt angle δr and the bucket angle γr at which the evaluation function Q becomes minimum.
The tilt angle δr represents an angle of the specific portion of the bucket 8 around the tilt axis AX4 for making the target construction topography CS and the specific portion of the bucket 8 parallel to each other. The bucket angle γr represents an angle of the specific portion of the bucket 8 around the bucket axis AX3.
The working equipment control unit 58 controls the tilt cylinder 14 and the bucket cylinder 13 so that the target construction topography CS and the specific portion of the bucket 8 become parallel to each other on the basis of the tilt angle δr and the bucket angle γr which are determined by the angle determination unit 57 (Step SB70).
In Step SB50, in a case where it is determined that the evaluation function Q is not minimum (Step SB50: No), the angle detection unit 57 updates the tilt angle δr or the bucket angle γr (Step SB80), and it returns to the processing in Step SB40.
Furthermore, in the above-described embodiment, with regard to the evaluation function Q, weighting may be performed to the evaluation function Q1 and the evaluation function Q2.
Furthermore, in the above-described embodiments, the construction machine 100 is assumed as the excavator. The constituent elements described in the embodiments are applicable to a construction machine including working equipment that is different from that of the excavator.
Furthermore, in the above-described embodiments, the upper swing body 2 may swing by a hydraulic pressure, or may swing by power that is generated by an electric actuator. In addition, the working equipment 1 may operate by power that is generated by an electric actuator instead of the hydraulic cylinder 10.
| Number | Date | Country | Kind |
|---|---|---|---|
| 2016-158832 | Aug 2016 | JP | national |
| Filing Document | Filing Date | Country | Kind |
|---|---|---|---|
| PCT/JP2017/027910 | 8/1/2017 | WO | 00 |
