WO2023050684A1 - Land leveling assistance system and method, and operation machine - Google Patents

Land leveling assistance system and method, and operation machine Download PDF

Info

Publication number
WO2023050684A1
WO2023050684A1 PCT/CN2022/076590 CN2022076590W WO2023050684A1 WO 2023050684 A1 WO2023050684 A1 WO 2023050684A1 CN 2022076590 W CN2022076590 W CN 2022076590W WO 2023050684 A1 WO2023050684 A1 WO 2023050684A1
Authority
WO
WIPO (PCT)
Prior art keywords
current
pose
leveling
boom
leveling operation
Prior art date
Application number
PCT/CN2022/076590
Other languages
French (fr)
Chinese (zh)
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 WO2023050684A1 publication Critical patent/WO2023050684A1/en

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/30Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom
    • E02F3/32Dredgers; 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 with a dipper-arm pivoted on a cantilever beam, i.e. boom working downwardly and towards the machine, e.g. with backhoes
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28Dredgers; 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/36Component parts
    • E02F3/42Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/437Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like providing automatic sequences of movements, e.g. linear excavation, keeping dipper angle constant

Definitions

  • the present application relates to the technical field of leveling operations, in particular to a leveling auxiliary system, method and operating machine.
  • the auxiliary function of leveling can not only improve the operation efficiency, but also improve the accuracy of leveling operations.
  • the opening and setting of the existing leveling auxiliary functions are very cumbersome. For example, it is necessary to turn on and off the auxiliary functions through the touch screen, set the reference point, trigger the auxiliary leveling function, etc. The process is very cumbersome. The operator continues to control the opening of the handle, which cannot reduce the workload of the operator, and if the working plane changes, a round of tedious settings needs to be performed again, which is inefficient.
  • the present application provides a leveling assistance system, method and operating machine to solve the defect of low leveling assistance efficiency in the prior art.
  • This application provides a leveling assistance system, including:
  • an acquisition unit configured to acquire the current pose of the working machine
  • an analysis unit configured to receive a leveling operation request carrying a leveling operation direction, and determine a next posture of the working machine based on the leveling operation direction and the current posture, and based on the next posture, A current leveling operation instruction is generated, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation instruction.
  • the current leveling operation command includes a current boom handle command, a current arm handle command, and a current bucket handle command
  • the analysis unit includes a boom analysis module and a stick analysis module
  • a bucket analysis module the current pose includes a current boom angle, a current stick angle, and a current bucket angle
  • the boom analysis module is used to determine the boom pose in the next pose based on the current boom angle, the current arm angle and the current bucket angle, and determine the boom pose in the next pose based on the boom in the next pose.
  • Pose generates the current boom handle command;
  • the stick analysis module is used to determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the stick pose of the next pose based on the stick pose of the next pose. Describe the current stick handle command;
  • the bucket analysis module is used to determine the bucket pose of the next pose based on the current bucket angle, and generate the current bucket handle command based on the bucket pose of the next pose .
  • the boom analysis module includes a first sub-analysis module, a second sub-analysis module, and an instruction generation module;
  • the first sub-analysis module is used to determine the current tooth tip height of the working machine based on the current boom angle, the current stick angle and the current bucket angle; the second sub-analysis module is used to determine the current tooth tip height based on the The current tooth tip height and the target tooth tip height determine the boom pose of the next pose; the instruction generation module is used to generate the current boom handle instruction based on the boom pose of the next pose .
  • the second sub-analysis module includes a calculation module and a determination module
  • the calculation module is used to determine the boom handle increment based on the current tooth tip height and the target tooth tip height; the determination module is used to determine the boom handle increment based on the last boom handle command and the boom handle increment. The boom pose for the next pose.
  • the calculation module includes a first calculation sub-module and a second calculation sub-module;
  • the first calculation submodule is used to calculate the difference between the current tooth tip height and the target tooth tip height; the second calculation submodule is used to calculate the difference based on the difference and the derivative of the difference , to determine the boom arm increment.
  • the system further includes an auxiliary unit, configured to generate an inner leveling operation command when it is detected that both the left and right handles are in the pull-down state, so that the vehicle controller based on The inner pulling and leveling operation instruction performs inner pulling and leveling operations, or when it is detected that the left and right handles are in the push-up state, an outer pushing and leveling operation instruction is generated, so that the vehicle controller can perform the outer pushing and leveling operations based on the outer pushing and leveling operations.
  • the application also provides a leveling assistance method, including:
  • the present application also provides a working machine, including: the above-mentioned ground leveling assisting system.
  • the present application also provides an electronic device, including a memory, a processor, and a computer program stored on the memory and operable on the processor.
  • the processor executes the computer program, any of the above-mentioned The steps of the Level Assist method.
  • the present application also provides a non-transitory computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of any one of the leveling assistance methods described above are implemented.
  • the present application also provides a computer program product, including a computer program, and when the computer program is executed by a processor, the steps of any one of the ground leveling assistance methods described above are implemented.
  • the leveling assistance system, method, and operating machine provided by this application can automatically determine the next position of the operating machine based on the leveling operation direction and the current position and posture in the leveling operation request, and automatically generate the current leveling operation based on the next position Instructions, so that the vehicle controller of the operating machine can perform leveling operations based on the current leveling operation instructions, so as to avoid the problems of low efficiency and poor practicability caused by the need to frequently turn on and set the leveling auxiliary functions in the traditional method.
  • Fig. 1 is a schematic structural diagram of the leveling assistance system provided by the present application.
  • Fig. 2 is the schematic diagram of the internal leveling operation provided by the application
  • Fig. 3 is the schematic diagram of extrapolation leveling operation provided by the present application.
  • Fig. 4 is a schematic structural diagram of another leveling assistance system provided by the present application.
  • Fig. 5 is a schematic diagram of the installation of the leveling auxiliary system provided by the present application.
  • Fig. 6 is one of the schematic flow charts of the leveling operation method based on the leveling auxiliary system provided by the present application;
  • Fig. 7 is the second schematic flow diagram of the leveling operation method based on the leveling auxiliary system provided by the present application.
  • Fig. 8 is a schematic flow chart of the leveling assistance method provided by the present application.
  • FIG. 9 is a schematic structural diagram of an electronic device provided by the present application.
  • the opening and setting of the existing leveling auxiliary functions are very cumbersome. For example, it is necessary to turn on and off the auxiliary functions through the touch screen, set the reference point, trigger the auxiliary leveling function, etc. The process is very cumbersome. The operator continues to control the opening of the handle, which cannot reduce the workload of the operator, and if the working plane changes, a round of tedious settings needs to be performed again, which is less efficient and practical.
  • FIG. 1 is a schematic structural diagram of the leveling assistance system provided by the present application.
  • the system includes an acquisition unit 110 and an analysis unit 120 .
  • the acquiring unit 110 may be provided with an inertial navigation sensor IMU for acquiring the current pose of the working machine, such as the current boom angle, the current arm angle, the current bucket angle, etc. of the working machine.
  • the operating machine refers to the construction machine that needs to perform leveling operations, such as an excavator.
  • the acquisition unit 110 After acquiring the current pose of the work machine, the acquisition unit 110 sends the current pose to the analysis unit 120, so that the analysis unit 120 determines the next pose of the work machine based on the leveling operation direction and the current pose in the leveling operation request , and based on the next posture, generate the current leveling operation command, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation command.
  • the ground leveling operation request can be generated when the driver pulls the handle, as shown in Figure 2, when the handle is pulled inward, it indicates that the tooth tip of the working machine needs to be close to the vehicle body to complete the ground leveling operation, that is, the leveling operation direction is tooth The sharp edge works close to the body.
  • the leveling operation direction is tooth The sharp edge works close to the body.
  • the handle when the handle is pushed outward, it indicates that the tooth tip of the operating machine needs to be kept away from the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is away from the vehicle body to perform operations.
  • the analysis unit 120 is connected to the vehicle controller VCU of the working machine, and can input the current leveling operation command to the vehicle controller VCU through the CAN bus, so that the vehicle controller VCU completes the leveling operation. That is to say, the leveling assistance system provided by the embodiment of the present application adds an acquisition unit and an analysis unit on the basis of the original system of the working machine, without the need to modify the original structure of the working machine, and the cost is relatively low.
  • the leveling assistance system provided by the embodiment of the present application can obtain the next position based on the current position and posture, and automatically generate the current leveling operation command, so that the vehicle controller of the working machine can perform leveling work based on the current leveling operation command without
  • the need to frequently turn on and set the leveling assistance function as in the traditional method causes the problems of low efficiency and poor practicability.
  • the leveling assistance system provided in the embodiment of the present application can automatically determine the next posture of the working machine based on the leveling operation direction and the current posture in the leveling operation request, and automatically generate the current leveling operation instruction based on the next posture, so as to
  • the vehicle controller of the operating machine is used to perform leveling operations based on the current leveling operation instructions, thereby avoiding the problems of low efficiency and poor practicability caused by frequently opening and setting leveling auxiliary functions in the traditional method.
  • the leveling assistance system adds an acquisition unit (including the inertial navigation sensor IMU) and an analysis unit (ACU) to the existing traditional leveling assistance system, and the IMU acquires the , stick and bucket angles to the ACU, and the ACU accurately calculates the next position of the operating machine through the angle returned by the IMU, and then analyzes the operator’s operation intention through the handle operation instructions generated by the operator operating the handle (such as flat ground working direction), calculate the handle lever opening command of the boom, arm and bucket, and finally output the control command to the vehicle controller (VCU) through CAN for auxiliary leveling operations.
  • the acquisition unit may be provided with an inertial navigation sensor IMU and an analysis unit (the ACU is provided on the body of the working machine) on the bucket, arm and boom respectively.
  • the current leveling operation command includes the current boom handle command, the current arm handle command and the current bucket handle command
  • the analysis unit includes the boom analysis module, the stick analysis module and the bucket analysis module
  • the current pose includes Current boom angle, current stick angle, and current bucket angle
  • the boom analysis module is used to determine the boom pose of the next pose based on the current boom angle, the current stick angle and the current bucket angle, and generate the current boom handle command based on the boom pose of the next pose ;
  • the stick analysis module is used to determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the current stick handle command based on the stick pose of the next pose;
  • the bucket analysis module is used to determine the next bucket pose based on the current bucket angle, and generate the current bucket handle command based on the next bucket pose.
  • the boom analysis module can determine the current tooth tip height based on the current boom angle, current stick angle, and current bucket angle, and then determine the next posture based on the current tooth tip height and the target height The boom pose of the next pose, and generate the current boom handle command based on the boom pose of the next pose.
  • the stick analysis module can determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the current stick boom command based on the stick pose of the next pose.
  • the target spline curve can be used to characterize the relationship between the current stick angle and the next stick angle, and the next stick angle can be determined according to the target spline curve, and then the stick pose of the next pose can be obtained, so that Generate the current stick boom command based on the stick pose.
  • the target spline curve may be a curve set by the user according to the actual situation.
  • the bucket analysis module can determine the next bucket pose based on the current bucket angle, and generate the current bucket boom command based on the next bucket pose. It should be noted that, usually during leveling operations, the bucket angle remains unchanged, that is, the bucket handle command is 0, and the bucket remains stationary.
  • the above commands are sent to the vehicle controller, so that the vehicle controller controls the boom, stick and shovel based on the above commands Bucket cooperation makes the position of the tip of the tooth move linearly to complete the leveling operation.
  • the boom analysis module includes a first sub-analysis module, a second sub-analysis module and an instruction generation module;
  • the first sub-analysis module is used to determine the current tooth tip height of the working machine based on the current boom angle, the current arm angle and the current bucket angle; the second sub-analysis module is used to determine the current tooth tip height based on the current tooth tip height and the target tooth tip height.
  • the boom pose of the next pose is determined; the instruction generation module is used to generate the current boom handle instruction based on the boom pose of the next pose.
  • the current tooth tip height of the working machine can be calculated, and combined with the target tooth tip height, the boom pose of the next posture can be obtained, so that Generate the current boom handle commands based on the boom pose for the next pose.
  • the target tooth tip height refers to the height that the tooth tip of the working machine needs to reach during leveling operations.
  • the second sub-analysis module includes a calculation module and a determination module
  • the calculation module is used to determine the boom handle increment based on the current tooth tip height and the target tooth tip height; the determination module is used to determine the boom pose of the next posture based on the previous boom handle instruction and the boom handle increment.
  • the boom handle increment is used to represent the increment of the boom pose of the next pose compared to the current boom pose. Based on the last boom handle instruction and the boom handle increment, the next bit can be determined position of the arm.
  • the calculation module includes a first calculation submodule and a second calculation submodule
  • the first calculation submodule is used to calculate the difference between the current tooth tip height and the target tooth tip height; the second calculation submodule is used to determine the boom arm increment based on the difference and the derivative of the difference.
  • the difference between the two can be determined, and then the difference and the derivative of the difference are used as input to calculate the arm increment of the boom.
  • a fuzzy algorithm, a PID algorithm, etc. may be used to calculate the arm increment of the boom, which is not specifically limited in this embodiment of the present application.
  • the IMU collects the current boom angle, the current arm angle and the current bucket angle, and the ACU performs pose calculation based on the above angles, and the current tooth tip height can be determined according to the tooth tip trajectory curve, combined with the current tooth tip height and The target tooth tip height determines the tooth tip difference E, and the tooth tip difference E and the imported EC of the tooth tip difference E are used as the input of the fuzzy controller to obtain the boom handle increment, and combined with the last boom handle command to obtain the current dynamic Arm handle commands.
  • the bucket remains stationary, that is, the current bucket handle command is a constant 0; the current bucket handle command can be determined based on the target spline curve.
  • the target spline curve can be a curve set by the user according to the actual situation
  • the system further includes an abnormality detection unit, configured to generate a standby instruction when an abnormal signal is detected, so that the system enters the debugging state after maintaining the standby state for a preset period of time.
  • an abnormality detection unit configured to generate a standby instruction when an abnormal signal is detected, so that the system enters the debugging state after maintaining the standby state for a preset period of time.
  • the abnormality detection unit will generate a standby command, so that the system will enter the debugging state after maintaining the standby state for a preset period of time. For example, when steel bars are encountered during leveling operations, the tip of the tooth cannot move at this time, but there will be a loading force on the tip of the tooth that will cause excessive torque. At this time, in order to avoid damage to the operating machinery caused by excessive torque, the system can be kept in standby mode After the preset time period, the abnormality is resolved at this time, and you can enter the debugging state to continue the leveling operation.
  • the leveling assist function is initially in the OFF state.
  • the driver turns on the leveling assist function, the system enters the debugging state (IDLE state); when the pose calculation is completed and the system is normal, it enters the work preparation (READY state). ), waiting for the driver to operate.
  • IDLE state debugging state
  • READY state work preparation
  • the system further includes an auxiliary unit, which is used to generate an inner leveling operation command when it is detected that both the left and right handles are in the pull-down state, so that the vehicle controller performs inner pulling based on the inner leveling operation command.
  • an extrapolation leveling operation instruction is generated, so that the vehicle controller performs extrapolation leveling operation based on the extrapolation leveling operation instruction.
  • the auxiliary unit is used to detect the state of the left and right handles.
  • the left and right handles are both in the pull-down state, and the system enters the state of pulling in the auxiliary level. Pose, generate the current boom handle command, the current arm handle command and the current bucket handle command and send them to the VCU, perform the inner pull leveling action, complete the leveling action or release any handle, the system returns to the READY state, and the driver Take manual control.
  • the system When the driver pushes up the left and right handles at the same time, and both the left and right handles are in the push-up state, the system enters the extrapolation auxiliary leveling state. At this time, an extrapolation leveling operation command is generated, and the ACU obtains the current pose through the IMU to generate the current boom handle command, current The stick handle command and the current bucket handle command are sent to the VCU to perform the push-out leveling action. After the leveling action is completed or any handle is released, the system returns to the READY state and is manually controlled by the driver.
  • the system When any abnormality occurs during the auxiliary leveling operation, the system enters the standby state (ABNORMAL state), and returns to the debugging state (IDLE state) after waiting for a certain period of time.
  • the driver turns off the level assist function, the system enters the shutdown state (OFF state).
  • the embodiment of the present invention adopts the human-computer interaction scheme to creatively use the combined operation of the handle to replace the complicated touch screen or button setting scheme. For example, pulling down the left and right handles at the same time can quickly trigger the internal leveling operation, and pushing the handle up at the same time can quickly trigger the operation. Extrapolation for leveling operations allows the operator to quickly and flexibly switch between semi-automatic auxiliary operations and manual operations. It is suitable for operations that frequently switch working modes and greatly improves operating efficiency.
  • the leveling assisting method provided in the present application is described below, and the leveling assisting method described below and the leveling assisting device described above can be referred to in correspondence.
  • the present application provides a leveling assistance method based on the leveling assistance system described in any of the above embodiments, as shown in FIG. 8 , the method includes:
  • Step 810 obtaining the current pose of the working machine
  • Step 820 Receive the leveling operation request carrying the leveling operation direction, determine the next posture of the working machine based on the leveling operation direction and the current posture, and generate the current leveling operation instruction based on the next posture, so that the working machine The vehicle controller performs leveling operations based on the current leveling operation command.
  • an inertial navigation sensor IMU can be respectively installed on the boom, stick, and bucket to obtain the current pose of the work machine, such as the current boom angle, current stick angle, and current position of the work machine. bucket angle etc.
  • the operating machine refers to the construction machine that needs to perform leveling operations, such as an excavator.
  • the vehicle controller After obtaining the current pose of the work machine, determine the next pose of the work machine based on the leveling direction and the current pose in the leveling request, and generate the current leveling command based on the next pose, so that the work machine
  • the vehicle controller performs leveling operations based on the current leveling operation command.
  • the leveling operation request can be generated when the driver pulls the handle.
  • the handle When the handle is pulled inward, it indicates that the tooth tip of the working machine needs to be close to the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is close to the vehicle body to perform operations. .
  • the handle When the handle is pushed outward, it indicates that the tooth tip of the operating machine needs to be kept away from the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is away from the vehicle body for operation.
  • the leveling assistance system provided by the embodiment of the present application can obtain the next position based on the current position and posture, and automatically generate the current leveling operation command, so that the vehicle controller of the working machine can perform the leveling operation based on the current leveling operation command, without the need for In the traditional method, it is necessary to frequently turn on and set the leveling auxiliary function, resulting in problems of low efficiency and poor practicability.
  • the present application provides a work machine, including: the ground leveling assisting system as described in any one of the above embodiments.
  • the leveling assistance system can automatically determine the next posture of the operation machine based on the leveling operation direction and the current posture in the leveling operation request, and automatically generate the current leveling operation instruction based on the next posture, so that the operation machine
  • the vehicle controller performs leveling operations based on the current leveling operation instructions, so as to avoid the problems of low efficiency and poor practicability caused by the need to frequently turn on and set leveling auxiliary functions in the traditional method.
  • Fig. 9 is a schematic structural diagram of an electronic device provided by the present application.
  • the electronic device may include: a processor (processor) 910, a communication interface (Communications Interface) 920, a memory (memory) 930 and a communication bus 940, Wherein, the processor 910 , the communication interface 920 , and the memory 930 communicate with each other through the communication bus 940 .
  • the processor 910 can call the logic instructions in the memory 930 to execute the leveling assistance method, the method includes: obtaining the current pose of the working machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the obtained Based on the current pose, determine the next pose of the work machine, and based on the next pose, generate a current leveling operation command, so that the vehicle controller of the work machine performs the operation based on the current leveling operation command Work on flat ground.
  • the above-mentioned logic instructions in the memory 930 may be implemented in the form of software function units and be stored in a computer-readable storage medium when sold or used as an independent product.
  • the technical solution of the present application is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including Several instructions are used to make a computer device (which may be a personal computer, a server, or a network device, etc.) execute all or part of the steps of the methods described in the various embodiments of the present application.
  • the aforementioned storage media include: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disc, etc., which can store program codes. .
  • the present application also provides a computer program product
  • the computer program product includes a computer program stored on a non-transitory computer-readable storage medium
  • the computer program includes program instructions, and when the program instructions are executed by a computer During execution, the computer can execute the leveling assistance method provided by the above methods, the method includes: obtaining the current pose of the working machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the current pose, determining a next pose of the working machine, and generating a current leveling operation instruction based on the next posture, so that the vehicle controller of the working machine performs leveling operations based on the current leveling operation instruction .
  • the present application also provides a non-transitory computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, it is implemented to perform the above-mentioned leveling assistance methods provided above, the method includes: obtaining The current pose of the work machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling work direction and the current pose, determining the next pose of the work machine, and based on the next position to generate a current leveling operation instruction, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation instruction.
  • the device embodiments described above are only illustrative, and the units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in One place, or it can be distributed to multiple network elements. Part or all of the modules can be selected according to actual needs to achieve the purpose of the solution of this embodiment. It can be understood and implemented by those skilled in the art without any creative effort.
  • each implementation can be implemented by means of software plus a necessary general hardware platform, and of course also by hardware.
  • the essence of the above technical solution or the part that contributes to the prior art can be embodied in the form of software products, and the computer software products can be stored in computer-readable storage media, such as ROM/RAM, magnetic discs, optical discs, etc., including several instructions to make a computer device (which may be a personal computer, server, or network device, etc.) execute the methods described in various embodiments or some parts of the embodiments.

Abstract

The present application provides a land leveling assistance system and method, and an operation machine. The system comprises: an acquisition unit and an analysis unit, wherein the acquisition unit is configured to acquire a current posture of an operation machine, and the analysis unit is configured to receive a land leveling operation request carrying a land leveling operation direction, determine the next posture of the operation machine on the basis of the land leveling operation direction and the current posture, and generate a current land leveling operation instruction on the basis of the next posture, so that a vehicle control unit of the operation machine performs land leveling operation on the basis of the current land leveling operation instruction. The present application can prevent problems of low efficiency and poor practicability caused by the need to frequently enable and set a land leveling assistance function in traditional methods.

Description

平地辅助系统、方法及作业机械Leveling assistance system, method and working machine
相关申请的交叉引用Cross References to Related Applications
本申请要求于2021年09月28日提交的申请号为202111145794.7,名称为“平地辅助系统、方法及作业机械”的中国专利申请的优先权,其通过引用方式全部并入本文。This application claims the priority of the Chinese patent application with application number 202111145794.7 filed on September 28, 2021, entitled "Graduate Assistance System, Method and Operating Machinery", which is incorporated herein by reference in its entirety.
技术领域technical field
本申请涉及平地作业技术领域,尤其涉及一种平地辅助系统、方法及作业机械。The present application relates to the technical field of leveling operations, in particular to a leveling auxiliary system, method and operating machine.
背景技术Background technique
在作业机械实际施工过程中,有大量需要平地作业的场景,平地辅助功能不仅可以提高作业效率,而且可以提升平地作业的精度。In the actual construction process of the operating machine, there are a large number of scenes that require leveling operations. The auxiliary function of leveling can not only improve the operation efficiency, but also improve the accuracy of leveling operations.
然而,现有平地辅助功能的开启和设置非常繁琐,例如需要通过触摸屏进行辅助功能开启关闭,参考点设置,辅助平地功能触发等,过程非常繁琐,此外上述设置完成后,使用平地辅助功能还是需要操作手持续控制手柄开度,并不能减少操作手的工作负荷,而且如果作业平面发生变化,还需要重新进行一轮繁琐的设置,效率较低。However, the opening and setting of the existing leveling auxiliary functions are very cumbersome. For example, it is necessary to turn on and off the auxiliary functions through the touch screen, set the reference point, trigger the auxiliary leveling function, etc. The process is very cumbersome. The operator continues to control the opening of the handle, which cannot reduce the workload of the operator, and if the working plane changes, a round of tedious settings needs to be performed again, which is inefficient.
发明内容Contents of the invention
本申请提供一种平地辅助系统、方法及作业机械,用以解决现有技术中平地辅助效率较低的缺陷。The present application provides a leveling assistance system, method and operating machine to solve the defect of low leveling assistance efficiency in the prior art.
本申请提供一种平地辅助系统,包括:This application provides a leveling assistance system, including:
获取单元,用于获取作业机械的当前位姿;an acquisition unit, configured to acquire the current pose of the working machine;
分析单元,用于接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。an analysis unit, configured to receive a leveling operation request carrying a leveling operation direction, and determine a next posture of the working machine based on the leveling operation direction and the current posture, and based on the next posture, A current leveling operation instruction is generated, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation instruction.
根据本申请提供的一种平地辅助系统,所述当前平地作业指令包括当前 动臂手柄指令、当前斗杆手柄指令以及当前铲斗手柄指令,所述分析单元包括动臂分析模块、斗杆分析模块以及铲斗分析模块,所述当前位姿包括当前动臂角度、当前斗杆角度以及当前铲斗角度;According to a leveling assistance system provided in the present application, the current leveling operation command includes a current boom handle command, a current arm handle command, and a current bucket handle command, and the analysis unit includes a boom analysis module and a stick analysis module And a bucket analysis module, the current pose includes a current boom angle, a current stick angle, and a current bucket angle;
所述动臂分析模块用于基于所述当前动臂角度、当前斗杆角度以及当前铲斗角度,确定所述下一位姿的动臂位姿,并基于所述下一位姿的动臂位姿生成所述当前动臂手柄指令;The boom analysis module is used to determine the boom pose in the next pose based on the current boom angle, the current arm angle and the current bucket angle, and determine the boom pose in the next pose based on the boom in the next pose. Pose generates the current boom handle command;
所述斗杆分析模块用于基于所述当前斗杆角度,从目标样条曲线中确定所述下一位姿的斗杆位姿,并基于所述下一位姿的斗杆位姿生成所述当前斗杆手柄指令;The stick analysis module is used to determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the stick pose of the next pose based on the stick pose of the next pose. Describe the current stick handle command;
所述铲斗分析模块用于基于所述当前铲斗角度,确定所述下一位姿的铲斗位姿,并基于所述下一位姿的铲斗位姿生成所述当前铲斗手柄指令。The bucket analysis module is used to determine the bucket pose of the next pose based on the current bucket angle, and generate the current bucket handle command based on the bucket pose of the next pose .
根据本申请提供的一种平地辅助系统,所述动臂分析模块包括第一子分析模块、第二子分析模块和指令生成模块;According to a leveling assistance system provided by the present application, the boom analysis module includes a first sub-analysis module, a second sub-analysis module, and an instruction generation module;
所述第一子分析模块用于基于所述当前动臂角度、当前斗杆角度以及当前铲斗角度,确定所述作业机械的当前齿尖高度;所述第二子分析模块用于基于所述当前齿尖高度以及目标齿尖高度,确定所述下一位姿的动臂位姿;所述指令生成模块用于基于所述下一位姿的动臂位姿生成所述当前动臂手柄指令。The first sub-analysis module is used to determine the current tooth tip height of the working machine based on the current boom angle, the current stick angle and the current bucket angle; the second sub-analysis module is used to determine the current tooth tip height based on the The current tooth tip height and the target tooth tip height determine the boom pose of the next pose; the instruction generation module is used to generate the current boom handle instruction based on the boom pose of the next pose .
根据本申请提供的一种平地辅助系统,所述第二子分析模块包括计算模块和确定模块;According to a leveling assistance system provided by the present application, the second sub-analysis module includes a calculation module and a determination module;
所述计算模块用于基于所述当前齿尖高度以及所述目标齿尖高度,确定动臂手柄增量;所述确定模块用于基于上一动臂手柄指令以及所述动臂手柄增量,确定所述下一位姿的动臂位姿。The calculation module is used to determine the boom handle increment based on the current tooth tip height and the target tooth tip height; the determination module is used to determine the boom handle increment based on the last boom handle command and the boom handle increment. The boom pose for the next pose.
根据本申请提供的一种平地辅助系统,所述计算模块包括第一计算子模块和第二计算子模块;According to a leveling assistance system provided by the present application, the calculation module includes a first calculation sub-module and a second calculation sub-module;
所述第一计算子模块用于计算所述当前齿尖高度与所述目标齿尖高度之间的差值;所述第二计算子模块用于基于所述差值以及所述差值的导数,确定所述动臂手臂增量。The first calculation submodule is used to calculate the difference between the current tooth tip height and the target tooth tip height; the second calculation submodule is used to calculate the difference based on the difference and the derivative of the difference , to determine the boom arm increment.
根据本申请提供的一种平地辅助系统,所述系统还包括辅助单元,用于在检测到左右手柄均处于下拉状态的情况下,生成内拉平地作业指令,以使 所述整车控制器基于所述内拉平地作业指令进行内拉平地作业,或在检测到左右手柄均处于上推状态的情况下,生成外推平地作业指令,以使所述整车控制器基于所述外推平地作业指令进行外推平地作业。According to a leveling assistance system provided by the present application, the system further includes an auxiliary unit, configured to generate an inner leveling operation command when it is detected that both the left and right handles are in the pull-down state, so that the vehicle controller based on The inner pulling and leveling operation instruction performs inner pulling and leveling operations, or when it is detected that the left and right handles are in the push-up state, an outer pushing and leveling operation instruction is generated, so that the vehicle controller can perform the outer pushing and leveling operations based on the outer pushing and leveling operations. Command to carry out extrapolation leveling operations.
本申请还提供一种平地辅助方法,包括:The application also provides a leveling assistance method, including:
获取作业机械的当前位姿;Obtain the current pose of the operating machine;
接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the current pose, determining the next posture of the working machine, and generating a current leveling operation instruction based on the next posture , so that the vehicle controller of the working machine performs leveling operations based on the current leveling operation instruction.
本申请还提供一种作业机械,包括:如上所述的平地辅助系统。The present application also provides a working machine, including: the above-mentioned ground leveling assisting system.
本申请还提供一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器执行所述计算机程序时实现如上述任一种所述平地辅助方法的步骤。The present application also provides an electronic device, including a memory, a processor, and a computer program stored on the memory and operable on the processor. When the processor executes the computer program, any of the above-mentioned The steps of the Level Assist method.
本申请还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现如上述任一种所述平地辅助方法的步骤。The present application also provides a non-transitory computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, the steps of any one of the leveling assistance methods described above are implemented.
本申请还提供一种计算机程序产品,包括计算机程序,所述计算机程序被处理器执行时实现如上述任一种所述平地辅助方法的步骤。The present application also provides a computer program product, including a computer program, and when the computer program is executed by a processor, the steps of any one of the ground leveling assistance methods described above are implemented.
本申请提供的平地辅助系统、方法及作业机械,基于平地作业请求中的平地作业方向以及当前位姿,能够自动确定作业机械的下一位姿,并基于下一位姿,自动生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业,从而可以避免传统方法中需要频繁开启和设置平地辅助功能造成效率较低且实用性较差的问题。The leveling assistance system, method, and operating machine provided by this application can automatically determine the next position of the operating machine based on the leveling operation direction and the current position and posture in the leveling operation request, and automatically generate the current leveling operation based on the next position Instructions, so that the vehicle controller of the operating machine can perform leveling operations based on the current leveling operation instructions, so as to avoid the problems of low efficiency and poor practicability caused by the need to frequently turn on and set the leveling auxiliary functions in the traditional method.
附图说明Description of drawings
为了更清楚地说明本申请或现有技术中的技术方案,下面将对实施例或现有技术描述中所需要使用的附图作一简单地介绍,显而易见地,下面描述中的附图是本申请的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the technical solutions in this application or the prior art, the accompanying drawings that need to be used in the description of the embodiments or the prior art will be briefly introduced below. Obviously, the accompanying drawings in the following description are the present For some embodiments of the application, those skilled in the art can also obtain other drawings based on these drawings without creative work.
图1是本申请提供的平地辅助系统的结构示意图;Fig. 1 is a schematic structural diagram of the leveling assistance system provided by the present application;
图2是本申请提供的内拉平地作业的示意图;Fig. 2 is the schematic diagram of the internal leveling operation provided by the application;
图3是本申请提供的外推平地作业的示意图;Fig. 3 is the schematic diagram of extrapolation leveling operation provided by the present application;
图4是本申请提供的又一平地辅助系统的结构示意图;Fig. 4 is a schematic structural diagram of another leveling assistance system provided by the present application;
图5是本申请提供的平地辅助系统的安装示意图;Fig. 5 is a schematic diagram of the installation of the leveling auxiliary system provided by the present application;
图6是本申请提供的基于平地辅助系统的平地作业方法的流程示意图之一;Fig. 6 is one of the schematic flow charts of the leveling operation method based on the leveling auxiliary system provided by the present application;
图7是本申请提供的基于平地辅助系统的平地作业方法的流程示意图之二;Fig. 7 is the second schematic flow diagram of the leveling operation method based on the leveling auxiliary system provided by the present application;
图8是本申请提供的平地辅助方法的流程示意图;Fig. 8 is a schematic flow chart of the leveling assistance method provided by the present application;
图9是本申请提供的电子设备的结构示意图。FIG. 9 is a schematic structural diagram of an electronic device provided by the present application.
具体实施方式Detailed ways
为使本申请的目的、技术方案和优点更加清楚,下面将结合本申请中的附图,对本申请中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。In order to make the purpose, technical solutions and advantages of this application clearer, the technical solutions in this application will be clearly and completely described below in conjunction with the accompanying drawings in this application. Obviously, the described embodiments are part of the embodiments of this application , but not all examples. Based on the embodiments in this application, all other embodiments obtained by persons of ordinary skill in the art without creative efforts fall within the protection scope of this application.
操作手开启平地功能后,控制动臂,斗杆及铲斗,将齿尖放置在平地作业面的起始位置,通过一定的设置,然后只需要通过斗杆或动臂操作手柄触发平地辅助功能,作业机械(如挖掘机)的齿尖将自动按照直线移动。After the operator turns on the leveling function, he controls the boom, arm and bucket, places the tip of the tooth at the starting position of the leveling work surface, and after passing certain settings, he only needs to trigger the auxiliary function of leveling through the stick or the operating handle of the boom , The tip of the tooth of the working machine (such as an excavator) will automatically move in a straight line.
然而,现有平地辅助功能的开启和设置非常繁琐,例如需要通过触摸屏进行辅助功能开启关闭,参考点设置,辅助平地功能触发等,过程非常繁琐,此外上述设置完成后,使用平地辅助功能还是需要操作手持续控制手柄开度,并不能减少操作手的工作负荷,而且如果作业平面发生变化,还需要重新进行一轮繁琐的设置,效率和实用性较差。However, the opening and setting of the existing leveling auxiliary functions are very cumbersome. For example, it is necessary to turn on and off the auxiliary functions through the touch screen, set the reference point, trigger the auxiliary leveling function, etc. The process is very cumbersome. The operator continues to control the opening of the handle, which cannot reduce the workload of the operator, and if the working plane changes, a round of tedious settings needs to be performed again, which is less efficient and practical.
对此,本申请提供一种图1是本申请提供的平地辅助系统。图1是本申请提供的图1是本申请提供的平地辅助系统的结构示意图,如图1所示,该系统包括获取单元110和分析单元120。In this regard, the present application provides a leveling assistance system provided in the present application as shown in FIG. 1 . FIG. 1 is a schematic structural diagram of the leveling assistance system provided by the present application. As shown in FIG. 1 , the system includes an acquisition unit 110 and an analysis unit 120 .
其中,获取单元110中可以设置有惯导传感器IMU,用于获取作业机械的当前位姿,如作业机械的当前动臂角度、当前斗杆角度、当前铲斗角度等。此处,作业机械指需要进行平地作业的工程机械,如挖掘机。Wherein, the acquiring unit 110 may be provided with an inertial navigation sensor IMU for acquiring the current pose of the working machine, such as the current boom angle, the current arm angle, the current bucket angle, etc. of the working machine. Here, the operating machine refers to the construction machine that needs to perform leveling operations, such as an excavator.
在获取作业机械的当前位姿后,获取单元110将当前位姿发送至分析单元120,以使分析单元120基于平地作业请求中的平地作业方向以及当前位 姿,确定作业机械的下一位姿,并基于下一位姿,生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业。After acquiring the current pose of the work machine, the acquisition unit 110 sends the current pose to the analysis unit 120, so that the analysis unit 120 determines the next pose of the work machine based on the leveling operation direction and the current pose in the leveling operation request , and based on the next posture, generate the current leveling operation command, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation command.
此处,平地作业请求可以是驾驶员拉动手柄时生成的,如图2所示,当手柄内拉时,表明当前需要使得作业机械的齿尖沿靠近车身完成平地作业,即平地作业方向为齿尖沿靠近车身进行作业。如图3所示,当手柄外推时,表明当前需要使得作业机械的齿尖沿远离车身完成平地作业,即平地作业方向为齿尖沿远离车身进行作业。Here, the ground leveling operation request can be generated when the driver pulls the handle, as shown in Figure 2, when the handle is pulled inward, it indicates that the tooth tip of the working machine needs to be close to the vehicle body to complete the ground leveling operation, that is, the leveling operation direction is tooth The sharp edge works close to the body. As shown in Figure 3, when the handle is pushed outward, it indicates that the tooth tip of the operating machine needs to be kept away from the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is away from the vehicle body to perform operations.
需要说明的是,分析单元120与作业机械的整车控制器VCU连接,并可以通过CAN总线将当前平地作业指令输入至整车控制器VCU,以使整车控制器VCU完成平地作业。也就是,本申请实施例提供的平地辅助系统是在作业机械的原有系统基础上,增加了获取单元和分析单元,而无需对作业机械的原有架构进行改造,成本较低。It should be noted that the analysis unit 120 is connected to the vehicle controller VCU of the working machine, and can input the current leveling operation command to the vehicle controller VCU through the CAN bus, so that the vehicle controller VCU completes the leveling operation. That is to say, the leveling assistance system provided by the embodiment of the present application adds an acquisition unit and an analysis unit on the basis of the original system of the working machine, without the need to modify the original structure of the working machine, and the cost is relatively low.
此外,本申请实施例提供的平地辅助系统可以基于当前位姿得到下一位姿,并自动生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业,而不需要像传统方法中需要频繁开启和设置平地辅助功能造成效率较低且实用性较差的问题。In addition, the leveling assistance system provided by the embodiment of the present application can obtain the next position based on the current position and posture, and automatically generate the current leveling operation command, so that the vehicle controller of the working machine can perform leveling work based on the current leveling operation command without The need to frequently turn on and set the leveling assistance function as in the traditional method causes the problems of low efficiency and poor practicability.
本申请实施例提供的平地辅助系统,基于平地作业请求中的平地作业方向以及当前位姿,能够自动确定作业机械的下一位姿,并基于下一位姿,自动生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业,从而可以避免传统方法中需要频繁开启和设置平地辅助功能造成效率较低且实用性较差的问题。The leveling assistance system provided in the embodiment of the present application can automatically determine the next posture of the working machine based on the leveling operation direction and the current posture in the leveling operation request, and automatically generate the current leveling operation instruction based on the next posture, so as to The vehicle controller of the operating machine is used to perform leveling operations based on the current leveling operation instructions, thereby avoiding the problems of low efficiency and poor practicability caused by frequently opening and setting leveling auxiliary functions in the traditional method.
如图4和图5所示,本申请实施例提供的平地辅助系统在现有传统的平地辅助系统中增加一个获取单元(包括惯导传感器IMU)及一个分析单元(ACU),IMU采集动臂、斗杆及铲斗的角度至ACU,ACU通过IMU返回的角度,精确计算出作业机械的下一位姿,然后通过操作手操作手柄生成的手柄操作指令,解析操作手的操作意图(如平地作业方向),计算出动臂、斗杆和铲斗的手柄杆开度指令,最终通过CAN输出控制指令至整车控制器(VCU)进行辅助平地作业。其中,获取单元可以分别在铲斗、斗杆和动臂上各设置有惯导传感器IMU,分析单元(ACU设置于作业机械的车身)。As shown in Figure 4 and Figure 5, the leveling assistance system provided by the embodiment of the present application adds an acquisition unit (including the inertial navigation sensor IMU) and an analysis unit (ACU) to the existing traditional leveling assistance system, and the IMU acquires the , stick and bucket angles to the ACU, and the ACU accurately calculates the next position of the operating machine through the angle returned by the IMU, and then analyzes the operator’s operation intention through the handle operation instructions generated by the operator operating the handle (such as flat ground working direction), calculate the handle lever opening command of the boom, arm and bucket, and finally output the control command to the vehicle controller (VCU) through CAN for auxiliary leveling operations. Wherein, the acquisition unit may be provided with an inertial navigation sensor IMU and an analysis unit (the ACU is provided on the body of the working machine) on the bucket, arm and boom respectively.
基于上述实施例,当前平地作业指令包括当前动臂手柄指令、当前斗杆 手柄指令以及当前铲斗手柄指令,分析单元包括动臂分析模块、斗杆分析模块以及铲斗分析模块,当前位姿包括当前动臂角度、当前斗杆角度以及当前铲斗角度;Based on the above-mentioned embodiment, the current leveling operation command includes the current boom handle command, the current arm handle command and the current bucket handle command, the analysis unit includes the boom analysis module, the stick analysis module and the bucket analysis module, and the current pose includes Current boom angle, current stick angle, and current bucket angle;
动臂分析模块用于基于当前动臂角度、当前斗杆角度以及当前铲斗角度,确定下一位姿的动臂位姿,并基于下一位姿的动臂位姿生成当前动臂手柄指令;The boom analysis module is used to determine the boom pose of the next pose based on the current boom angle, the current stick angle and the current bucket angle, and generate the current boom handle command based on the boom pose of the next pose ;
斗杆分析模块用于基于当前斗杆角度,从目标样条曲线中确定下一位姿的斗杆位姿,并基于下一位姿的斗杆位姿生成当前斗杆手柄指令;The stick analysis module is used to determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the current stick handle command based on the stick pose of the next pose;
铲斗分析模块用于基于当前铲斗角度,确定下一位姿的铲斗位姿,并基于下一位姿的铲斗位姿生成当前铲斗手柄指令。The bucket analysis module is used to determine the next bucket pose based on the current bucket angle, and generate the current bucket handle command based on the next bucket pose.
具体地,在平地作业过程中,动臂分析模块可以基于当前动臂角度、当前斗杆角度以及当前铲斗角度,确定当前齿尖高度,然后基于当前齿尖高度以及目标高度确定下一位姿的动臂位姿,并基于下一位姿的动臂位姿生成当前动臂手柄指令。Specifically, during leveling operations, the boom analysis module can determine the current tooth tip height based on the current boom angle, current stick angle, and current bucket angle, and then determine the next posture based on the current tooth tip height and the target height The boom pose of the next pose, and generate the current boom handle command based on the boom pose of the next pose.
斗杆分析模块可以基于当前斗杆角度,从目标样条曲线中确定下一位姿的斗杆位姿,并基于下一位姿的斗杆位姿生成当前斗杆动臂指令。例如,目标样条曲线可以用于表征当前斗杆角度与下一斗杆角度的关系,根据目标样条曲线可以确定下一斗杆角度,进而得到下一位姿的斗杆位姿,从而可以基于斗杆位姿生成当前斗杆动臂指令。其中,目标样条曲线可以是用户根据实际情况设置的曲线。The stick analysis module can determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the current stick boom command based on the stick pose of the next pose. For example, the target spline curve can be used to characterize the relationship between the current stick angle and the next stick angle, and the next stick angle can be determined according to the target spline curve, and then the stick pose of the next pose can be obtained, so that Generate the current stick boom command based on the stick pose. Wherein, the target spline curve may be a curve set by the user according to the actual situation.
铲斗分析模块可以基于当前铲斗角度,确定下一位姿的铲斗位姿,并基于下一位姿的铲斗位姿生成当前铲斗动臂指令。需要说明的是,通常在平地作业过程中,铲斗角度不变保持不动,即铲斗手柄指令为0,铲斗保持不动。The bucket analysis module can determine the next bucket pose based on the current bucket angle, and generate the current bucket boom command based on the next bucket pose. It should be noted that, usually during leveling operations, the bucket angle remains unchanged, that is, the bucket handle command is 0, and the bucket remains stationary.
在得到当前动臂手柄指令、当前斗杆动臂指令以及当前斗杆动臂指令后,将上述指令发送至整车控制器,以使整车控制器基于上述指令控制动臂、斗杆以及铲斗协作使齿尖位置直线移动,以完成平地作业。After obtaining the current boom handle command, the current stick boom command and the current stick boom command, the above commands are sent to the vehicle controller, so that the vehicle controller controls the boom, stick and shovel based on the above commands Bucket cooperation makes the position of the tip of the tooth move linearly to complete the leveling operation.
基于上述任一实施例,动臂分析模块包括第一子分析模块、第二子分析模块和指令生成模块;Based on any of the above embodiments, the boom analysis module includes a first sub-analysis module, a second sub-analysis module and an instruction generation module;
第一子分析模块用于基于当前动臂角度、当前斗杆角度以及当前铲斗角度,确定作业机械的当前齿尖高度;第二子分析模块用于基于当前齿尖高度 以及目标齿尖高度,确定下一位姿的动臂位姿;指令生成模块用于基于下一位姿的动臂位姿生成当前动臂手柄指令。The first sub-analysis module is used to determine the current tooth tip height of the working machine based on the current boom angle, the current arm angle and the current bucket angle; the second sub-analysis module is used to determine the current tooth tip height based on the current tooth tip height and the target tooth tip height. The boom pose of the next pose is determined; the instruction generation module is used to generate the current boom handle instruction based on the boom pose of the next pose.
具体地,根据当前动臂角度、当前斗杆角度以及当前铲斗角度,可以计算得到作业机械的当前齿尖高度,并结合目标齿尖高度,得到下一位姿的动臂位姿,从而可以基于下一位姿的动臂位姿生成当前动臂手柄指令。其中,目标齿尖高度是指平地作业过程中作业机械的齿尖需要达到的高度。Specifically, according to the current boom angle, the current stick angle and the current bucket angle, the current tooth tip height of the working machine can be calculated, and combined with the target tooth tip height, the boom pose of the next posture can be obtained, so that Generate the current boom handle commands based on the boom pose for the next pose. Wherein, the target tooth tip height refers to the height that the tooth tip of the working machine needs to reach during leveling operations.
需要说明的是,为了保证平地作业的平稳进行,需要将齿尖的高度缓慢调整至目标齿尖高度,而不是直接将齿尖高度调整至目标齿尖高度。It should be noted that, in order to ensure smooth ground leveling, it is necessary to slowly adjust the height of the tooth tip to the target tooth tip height instead of directly adjusting the tooth tip height to the target tooth tip height.
基于上述任一实施例,第二子分析模块包括计算模块和确定模块;Based on any of the above embodiments, the second sub-analysis module includes a calculation module and a determination module;
计算模块用于基于当前齿尖高度以及目标齿尖高度,确定动臂手柄增量;确定模块用于基于上一动臂手柄指令以及动臂手柄增量,确定下一位姿的动臂位姿。The calculation module is used to determine the boom handle increment based on the current tooth tip height and the target tooth tip height; the determination module is used to determine the boom pose of the next posture based on the previous boom handle instruction and the boom handle increment.
具体地,动臂手柄增量用于表征下一位姿的动臂位姿相较于当前动臂位姿的增量,基于上一动臂手柄指令以及动臂手柄增量,可以确定下一位姿的动臂位姿。Specifically, the boom handle increment is used to represent the increment of the boom pose of the next pose compared to the current boom pose. Based on the last boom handle instruction and the boom handle increment, the next bit can be determined position of the arm.
若要使动臂在下一时刻能够达到下一位姿的动臂位姿,则需要结合上一动臂手柄指令生成当前动臂手柄指令,以使整车控制器基于当前动臂手柄指令控制动臂。To enable the boom to reach the boom pose of the next pose at the next moment, it is necessary to combine the last boom handle command to generate the current boom handle command, so that the vehicle controller can control the boom based on the current boom handle command .
基于上述任一实施例,计算模块包括第一计算子模块和第二计算子模块;Based on any of the above embodiments, the calculation module includes a first calculation submodule and a second calculation submodule;
第一计算子模块用于计算当前齿尖高度与目标齿尖高度之间的差值;第二计算子模块用于基于差值以及差值的导数,确定动臂手臂增量。The first calculation submodule is used to calculate the difference between the current tooth tip height and the target tooth tip height; the second calculation submodule is used to determine the boom arm increment based on the difference and the derivative of the difference.
具体地,在得到当前齿尖高度与目标齿尖高度之后,可以确定两者之间的差值,然后以差值和差值的导数作为输入,计算动臂手臂增量。其中,可以采用模糊算法、PID算法等计算动臂手臂增量,本申请实施例对此不作具体限定。Specifically, after obtaining the current tooth tip height and the target tooth tip height, the difference between the two can be determined, and then the difference and the derivative of the difference are used as input to calculate the arm increment of the boom. Wherein, a fuzzy algorithm, a PID algorithm, etc. may be used to calculate the arm increment of the boom, which is not specifically limited in this embodiment of the present application.
如图6所示,IMU采集当前动臂角度、当前斗杆角度以及当前铲斗角度,ACU基于上述角度进行位姿计算,根据齿尖轨迹曲线可以确定当前齿尖高度,结合当前齿尖高度以及目标齿尖高度确定齿尖差值E,以齿尖差值E以及齿尖差值E的导入EC作为模糊控制器的输入,得到动臂手柄增量,并结合上一动臂手柄指令得到当前动臂手柄指令。此外,在平地作业过程中,铲斗保 持不动,即当前铲斗手柄指令为常量0;当前铲斗手柄指令可以基于目标样条曲线确定。将上述当前动臂手柄指令、当前斗杆手柄指令以及当前铲斗手柄指令发给VCU,使动臂、斗杆和铲斗三个工作装置相互协调运动,以使齿尖位置移动,实现平地作业。其中,目标样条曲线可以是用户根据实际情况设置的曲线,As shown in Figure 6, the IMU collects the current boom angle, the current arm angle and the current bucket angle, and the ACU performs pose calculation based on the above angles, and the current tooth tip height can be determined according to the tooth tip trajectory curve, combined with the current tooth tip height and The target tooth tip height determines the tooth tip difference E, and the tooth tip difference E and the imported EC of the tooth tip difference E are used as the input of the fuzzy controller to obtain the boom handle increment, and combined with the last boom handle command to obtain the current dynamic Arm handle commands. In addition, during the leveling operation, the bucket remains stationary, that is, the current bucket handle command is a constant 0; the current bucket handle command can be determined based on the target spline curve. Send the above-mentioned current boom handle command, current arm handle command and current bucket handle command to the VCU, so that the three working devices of the boom, stick and bucket can move in coordination with each other, so that the position of the tooth tip can be moved to realize leveling operations . Among them, the target spline curve can be a curve set by the user according to the actual situation,
基于上述任一实施例,系统还包括异常检测单元,用于在检测到异常信号时,生成待机指令,以使系统在保持待机状态预设时长后,再进入调试状态。Based on any of the above embodiments, the system further includes an abnormality detection unit, configured to generate a standby instruction when an abnormal signal is detected, so that the system enters the debugging state after maintaining the standby state for a preset period of time.
具体地,在平地作业过程中,若发生异常情况,则异常检测单元会生成待机指令,以使系统在保持待机状态预设时长后,再进入调试状态。例如,当平地作业过程中遇到钢筋时,此时齿尖无法移动,但齿尖会存在加载力导致扭矩过大,此时为了避免过大扭矩对作业机械造成损坏,可以使系统保持待机状态预设时长后,此时异常解除,可以进入调试状态,以继续进行平地作业。Specifically, if an abnormal situation occurs during leveling operations, the abnormality detection unit will generate a standby command, so that the system will enter the debugging state after maintaining the standby state for a preset period of time. For example, when steel bars are encountered during leveling operations, the tip of the tooth cannot move at this time, but there will be a loading force on the tip of the tooth that will cause excessive torque. At this time, in order to avoid damage to the operating machinery caused by excessive torque, the system can be kept in standby mode After the preset time period, the abnormality is resolved at this time, and you can enter the debugging state to continue the leveling operation.
如图7所示,平地辅助功能初始为OFF状态,当驾驶员开启平地辅助功能后,系统进入调试状态(IDLE状态);当位姿计算完成,且系统无异常后,进入工作准备(READY状态),等待驾驶员操作。As shown in Figure 7, the leveling assist function is initially in the OFF state. When the driver turns on the leveling assist function, the system enters the debugging state (IDLE state); when the pose calculation is completed and the system is normal, it enters the work preparation (READY state). ), waiting for the driver to operate.
基于上述任一实施例,系统还包括辅助单元,用于在检测到左右手柄均处于下拉状态的情况下,生成内拉平地作业指令,以使整车控制器基于内拉平地作业指令进行内拉平地作业,或在检测到左右手柄均处于上推状态的情况下,生成外推平地作业指令,以使整车控制器基于外推平地作业指令进行外推平地作业。Based on any of the above-mentioned embodiments, the system further includes an auxiliary unit, which is used to generate an inner leveling operation command when it is detected that both the left and right handles are in the pull-down state, so that the vehicle controller performs inner pulling based on the inner leveling operation command. Leveling operations, or when it is detected that both the left and right handles are in the push-up state, an extrapolation leveling operation instruction is generated, so that the vehicle controller performs extrapolation leveling operation based on the extrapolation leveling operation instruction.
具体地,辅助单元用于检测左右手柄的状态,当驾驶员同时下拉左右手柄,左右手柄均处于下拉状态,系统进入内拉辅助平地状态,此时生成内拉平地作业指令,ACU通过IMU获取当前位姿,生成当前动臂手柄指令、当前斗杆手柄指令以及当前铲斗手柄指令发送至VCU,执行内拉平地动作,完成平地动作或松开任一手柄,系统回到READY状态,由驾驶员进行手动控制。Specifically, the auxiliary unit is used to detect the state of the left and right handles. When the driver pulls down the left and right handles at the same time, the left and right handles are both in the pull-down state, and the system enters the state of pulling in the auxiliary level. Pose, generate the current boom handle command, the current arm handle command and the current bucket handle command and send them to the VCU, perform the inner pull leveling action, complete the leveling action or release any handle, the system returns to the READY state, and the driver Take manual control.
当驾驶员同时上推左右手柄,左右手柄均处于上推状态,系统进入外推辅助平地状态,此时生成外推平地作业指令,ACU通过IMU获取当前位姿,生成当前动臂手柄指令、当前斗杆手柄指令以及当前铲斗手柄指令发送至 VCU,执行外推平地动作,完成平地动作或松开任一手柄,系统回到READY状态,由驾驶员进行手动控制。When the driver pushes up the left and right handles at the same time, and both the left and right handles are in the push-up state, the system enters the extrapolation auxiliary leveling state. At this time, an extrapolation leveling operation command is generated, and the ACU obtains the current pose through the IMU to generate the current boom handle command, current The stick handle command and the current bucket handle command are sent to the VCU to perform the push-out leveling action. After the leveling action is completed or any handle is released, the system returns to the READY state and is manually controlled by the driver.
当辅助平地作业过程中有任何异常发生,系统进入待机状态(ABNORMAL状态),等待一定时间后回到调试状态(IDLE状态)。当驾驶员关闭平地辅助功能时,系统进入关机状态(OFF状态)。When any abnormality occurs during the auxiliary leveling operation, the system enters the standby state (ABNORMAL state), and returns to the debugging state (IDLE state) after waiting for a certain period of time. When the driver turns off the level assist function, the system enters the shutdown state (OFF state).
由此可见,本发明实施例采用人机交互方案创造性的使用手柄组合操作替代复杂的触摸屏或按钮设置方案,如同时下拉左右手柄,可以快速触发内拉平地作业,同时上推手柄,可以快速触发外推平地作业,从而让操作手可以在半自动辅助作业与人工作业间快速灵活的进行切换,适合频繁切换工作模式的作业,大幅提高作业效率。It can be seen that the embodiment of the present invention adopts the human-computer interaction scheme to creatively use the combined operation of the handle to replace the complicated touch screen or button setting scheme. For example, pulling down the left and right handles at the same time can quickly trigger the internal leveling operation, and pushing the handle up at the same time can quickly trigger the operation. Extrapolation for leveling operations allows the operator to quickly and flexibly switch between semi-automatic auxiliary operations and manual operations. It is suitable for operations that frequently switch working modes and greatly improves operating efficiency.
下面对本申请提供的平地辅助方法进行描述,下文描述的平地辅助方法与上文描述的平地辅助装置可相互对应参照。The leveling assisting method provided in the present application is described below, and the leveling assisting method described below and the leveling assisting device described above can be referred to in correspondence.
基于上述任一实施例,本申请提供一种基于如上任一实施例所述平地辅助系统的平地辅助方法,如图8所示,该方法包括:Based on any of the above embodiments, the present application provides a leveling assistance method based on the leveling assistance system described in any of the above embodiments, as shown in FIG. 8 , the method includes:
步骤810、获取作业机械的当前位姿; Step 810, obtaining the current pose of the working machine;
步骤820、接收携带有平地作业方向的平地作业请求,并基于平地作业方向以及当前位姿,确定作业机械的下一位姿,以及基于下一位姿,生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业。Step 820: Receive the leveling operation request carrying the leveling operation direction, determine the next posture of the working machine based on the leveling operation direction and the current posture, and generate the current leveling operation instruction based on the next posture, so that the working machine The vehicle controller performs leveling operations based on the current leveling operation command.
具体地,本申请实施例可以分别在动臂、斗杆和铲斗上设置惯导传感器IMU,用于获取作业机械的当前位姿,如作业机械的当前动臂角度、当前斗杆角度、当前铲斗角度等。此处,作业机械指需要进行平地作业的工程机械,如挖掘机。Specifically, in the embodiment of the present application, an inertial navigation sensor IMU can be respectively installed on the boom, stick, and bucket to obtain the current pose of the work machine, such as the current boom angle, current stick angle, and current position of the work machine. bucket angle etc. Here, the operating machine refers to the construction machine that needs to perform leveling operations, such as an excavator.
在获取作业机械的当前位姿后,基于平地作业请求中的平地作业方向以及当前位姿,确定作业机械的下一位姿,并基于下一位姿,生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业。After obtaining the current pose of the work machine, determine the next pose of the work machine based on the leveling direction and the current pose in the leveling request, and generate the current leveling command based on the next pose, so that the work machine The vehicle controller performs leveling operations based on the current leveling operation command.
此处,平地作业请求可以是驾驶员拉动手柄时生成的,当手柄内拉时,表明当前需要使得作业机械的齿尖沿靠近车身完成平地作业,即平地作业方向为齿尖沿靠近车身进行作业。当手柄外推时,表明当前需要使得作业机械的齿尖沿远离车身完成平地作业,即平地作业方向为齿尖沿远离车身进行作 业。Here, the leveling operation request can be generated when the driver pulls the handle. When the handle is pulled inward, it indicates that the tooth tip of the working machine needs to be close to the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is close to the vehicle body to perform operations. . When the handle is pushed outward, it indicates that the tooth tip of the operating machine needs to be kept away from the vehicle body to complete the leveling operation, that is, the leveling operation direction is that the tooth tip is away from the vehicle body for operation.
本申请实施例提供的平地辅助系统可以基于当前位姿得到下一位姿,并自动生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业,而不需要像传统方法中需要频繁开启和设置平地辅助功能造成效率较低且实用性较差的问题。The leveling assistance system provided by the embodiment of the present application can obtain the next position based on the current position and posture, and automatically generate the current leveling operation command, so that the vehicle controller of the working machine can perform the leveling operation based on the current leveling operation command, without the need for In the traditional method, it is necessary to frequently turn on and set the leveling auxiliary function, resulting in problems of low efficiency and poor practicability.
基于上述任一实施例,本申请提供一种作业机械,包括:如上任一实施例所述的平地辅助系统。Based on any one of the above embodiments, the present application provides a work machine, including: the ground leveling assisting system as described in any one of the above embodiments.
具体地,平地辅助系统可以基于平地作业请求中的平地作业方向以及当前位姿,能够自动确定作业机械的下一位姿,并基于下一位姿,自动生成当前平地作业指令,以使作业机械的整车控制器基于当前平地作业指令进行平地作业,从而可以避免传统方法中需要频繁开启和设置平地辅助功能造成效率较低且实用性较差的问题。Specifically, the leveling assistance system can automatically determine the next posture of the operation machine based on the leveling operation direction and the current posture in the leveling operation request, and automatically generate the current leveling operation instruction based on the next posture, so that the operation machine The vehicle controller performs leveling operations based on the current leveling operation instructions, so as to avoid the problems of low efficiency and poor practicability caused by the need to frequently turn on and set leveling auxiliary functions in the traditional method.
图9是本申请提供的电子设备的结构示意图,如图9所示,该电子设备可以包括:处理器(processor)910、通信接口(Communications Interface)920、存储器(memory)930和通信总线940,其中,处理器910,通信接口920,存储器930通过通信总线940完成相互间的通信。处理器910可以调用存储器930中的逻辑指令,以执行平地辅助方法,该方法包括:获取作业机械的当前位姿;接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。Fig. 9 is a schematic structural diagram of an electronic device provided by the present application. As shown in Fig. 9, the electronic device may include: a processor (processor) 910, a communication interface (Communications Interface) 920, a memory (memory) 930 and a communication bus 940, Wherein, the processor 910 , the communication interface 920 , and the memory 930 communicate with each other through the communication bus 940 . The processor 910 can call the logic instructions in the memory 930 to execute the leveling assistance method, the method includes: obtaining the current pose of the working machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the obtained Based on the current pose, determine the next pose of the work machine, and based on the next pose, generate a current leveling operation command, so that the vehicle controller of the work machine performs the operation based on the current leveling operation command Work on flat ground.
此外,上述的存储器930中的逻辑指令可以通过软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个计算机可读取存储介质中。基于这样的理解,本申请的技术方案本质上或者说对现有技术做出贡献的部分或者该技术方案的部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行本申请各个实施例所述方法的全部或部分步骤。而前述的存储介质包括:U盘、移动硬盘、只读存储器(ROM,Read-Only Memory)、随机存取存储器(RAM,Random Access Memory)、磁碟或者光盘等各种可以存储程序代码的介质。In addition, the above-mentioned logic instructions in the memory 930 may be implemented in the form of software function units and be stored in a computer-readable storage medium when sold or used as an independent product. Based on this understanding, the technical solution of the present application is essentially or the part that contributes to the prior art or the part of the technical solution can be embodied in the form of a software product, and the computer software product is stored in a storage medium, including Several instructions are used to make a computer device (which may be a personal computer, a server, or a network device, etc.) execute all or part of the steps of the methods described in the various embodiments of the present application. The aforementioned storage media include: U disk, mobile hard disk, read-only memory (ROM, Read-Only Memory), random access memory (RAM, Random Access Memory), magnetic disk or optical disc, etc., which can store program codes. .
另一方面,本申请还提供一种计算机程序产品,所述计算机程序产品包括存储在非暂态计算机可读存储介质上的计算机程序,所述计算机程序包括程序指令,当所述程序指令被计算机执行时,计算机能够执行上述各方法所提供的平地辅助方法,该方法包括:获取作业机械的当前位姿;接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。On the other hand, the present application also provides a computer program product, the computer program product includes a computer program stored on a non-transitory computer-readable storage medium, the computer program includes program instructions, and when the program instructions are executed by a computer During execution, the computer can execute the leveling assistance method provided by the above methods, the method includes: obtaining the current pose of the working machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the current pose, determining a next pose of the working machine, and generating a current leveling operation instruction based on the next posture, so that the vehicle controller of the working machine performs leveling operations based on the current leveling operation instruction .
又一方面,本申请还提供一种非暂态计算机可读存储介质,其上存储有计算机程序,该计算机程序被处理器执行时实现以执行上述各提供的平地辅助方法,该方法包括:获取作业机械的当前位姿;接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。In yet another aspect, the present application also provides a non-transitory computer-readable storage medium, on which a computer program is stored, and when the computer program is executed by a processor, it is implemented to perform the above-mentioned leveling assistance methods provided above, the method includes: obtaining The current pose of the work machine; receiving a leveling operation request carrying a leveling operation direction, and based on the leveling work direction and the current pose, determining the next pose of the work machine, and based on the next position to generate a current leveling operation instruction, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation instruction.
以上所描述的装置实施例仅仅是示意性的,其中所述作为分离部件说明的单元可以是或者也可以不是物理上分开的,作为单元显示的部件可以是或者也可以不是物理单元,即可以位于一个地方,或者也可以分布到多个网络单元上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施例方案的目的。本领域普通技术人员在不付出创造性的劳动的情况下,即可以理解并实施。The device embodiments described above are only illustrative, and the units described as separate components may or may not be physically separated, and the components shown as units may or may not be physical units, that is, they may be located in One place, or it can be distributed to multiple network elements. Part or all of the modules can be selected according to actual needs to achieve the purpose of the solution of this embodiment. It can be understood and implemented by those skilled in the art without any creative effort.
通过以上的实施方式的描述,本领域的技术人员可以清楚地了解到各实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分可以以软件产品的形式体现出来,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。Through the above description of the implementations, those skilled in the art can clearly understand that each implementation can be implemented by means of software plus a necessary general hardware platform, and of course also by hardware. Based on this understanding, the essence of the above technical solution or the part that contributes to the prior art can be embodied in the form of software products, and the computer software products can be stored in computer-readable storage media, such as ROM/RAM, magnetic discs, optical discs, etc., including several instructions to make a computer device (which may be a personal computer, server, or network device, etc.) execute the methods described in various embodiments or some parts of the embodiments.
最后应说明的是:以上实施例仅用以说明本申请的技术方案,而非对其限制;尽管参照前述实施例对本申请进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或 者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本申请各实施例技术方案的精神和范围。Finally, it should be noted that: the above embodiments are only used to illustrate the technical solutions of the present application, rather than limiting them; although the present application has been described in detail with reference to the foregoing embodiments, those of ordinary skill in the art should understand that: it can still Modifications are made to the technical solutions described in the foregoing embodiments, or equivalent replacements are made to some of the technical features; and these modifications or replacements do not make the essence of the corresponding technical solutions deviate from the spirit and scope of the technical solutions of the various embodiments of the present application.

Claims (10)

  1. 一种平地辅助系统,其特征在于,包括:A ground assist system, characterized by comprising:
    获取单元,用于获取作业机械的当前位姿;an acquisition unit, configured to acquire the current pose of the working machine;
    分析单元,用于接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。an analysis unit, configured to receive a leveling operation request carrying a leveling operation direction, and determine a next posture of the working machine based on the leveling operation direction and the current posture, and based on the next posture, A current leveling operation instruction is generated, so that the vehicle controller of the working machine performs leveling operation based on the current leveling operation instruction.
  2. 根据权利要求1所述的平地辅助系统,其特征在于,所述当前平地作业指令包括当前动臂手柄指令、当前斗杆手柄指令以及当前铲斗手柄指令,所述分析单元包括动臂分析模块、斗杆分析模块以及铲斗分析模块,所述当前位姿包括当前动臂角度、当前斗杆角度以及当前铲斗角度;The ground leveling assistance system according to claim 1, wherein the current leveling operation command includes a current boom handle command, a current stick handle command and a current bucket handle command, and the analysis unit includes a boom analysis module, A stick analysis module and a bucket analysis module, the current pose includes a current boom angle, a current stick angle, and a current bucket angle;
    所述动臂分析模块用于基于所述当前动臂角度、当前斗杆角度以及当前铲斗角度,确定所述下一位姿的动臂位姿,并基于所述下一位姿的动臂位姿生成所述当前动臂手柄指令;The boom analysis module is used to determine the boom pose in the next pose based on the current boom angle, the current arm angle and the current bucket angle, and determine the boom pose in the next pose based on the boom in the next pose. Pose generates the current boom handle command;
    所述斗杆分析模块用于基于所述当前斗杆角度,从目标样条曲线中确定所述下一位姿的斗杆位姿,并基于所述下一位姿的斗杆位姿生成所述当前斗杆手柄指令;The stick analysis module is used to determine the stick pose of the next pose from the target spline curve based on the current stick angle, and generate the stick pose of the next pose based on the stick pose of the next pose. Describe the current stick handle command;
    所述铲斗分析模块用于基于所述当前铲斗角度,确定所述下一位姿的铲斗位姿,并基于所述下一位姿的铲斗位姿生成所述当前铲斗手柄指令。The bucket analysis module is used to determine the bucket pose of the next pose based on the current bucket angle, and generate the current bucket handle command based on the bucket pose of the next pose .
  3. 根据权利要求2所述的平地辅助系统,其特征在于,所述动臂分析模块包括第一子分析模块、第二子分析模块和指令生成模块;The leveling assistance system according to claim 2, wherein the boom analysis module includes a first sub-analysis module, a second sub-analysis module, and an instruction generation module;
    所述第一子分析模块用于基于所述当前动臂角度、当前斗杆角度以及当前铲斗角度,确定所述作业机械的当前齿尖高度;所述第二子分析模块用于基于所述当前齿尖高度以及目标齿尖高度,确定所述下一位姿的动臂位姿;所述指令生成模块用于基于所述下一位姿的动臂位姿生成所述当前动臂手柄指令。The first sub-analysis module is used to determine the current tooth tip height of the working machine based on the current boom angle, the current stick angle and the current bucket angle; the second sub-analysis module is used to determine the current tooth tip height based on the The current tooth tip height and the target tooth tip height determine the boom pose of the next pose; the instruction generation module is used to generate the current boom handle instruction based on the boom pose of the next pose .
  4. 根据权利要求3所述的平地辅助系统,其特征在于,所述第二子分析模块包括计算模块和确定模块;The leveling assistance system according to claim 3, wherein the second sub-analysis module includes a calculation module and a determination module;
    所述计算模块用于基于所述当前齿尖高度以及所述目标齿尖高度,确定动臂手柄增量;所述确定模块用于基于上一动臂手柄指令以及所述动臂手柄 增量,确定所述下一位姿的动臂位姿。The calculation module is used to determine the boom handle increment based on the current tooth tip height and the target tooth tip height; the determination module is used to determine the boom handle increment based on the last boom handle command and the boom handle increment. The boom pose for the next pose.
  5. 根据权利要求4所述的平地辅助系统,其特征在于,所述计算模块包括第一计算子模块和第二计算子模块;The leveling assistance system according to claim 4, wherein the calculation module comprises a first calculation submodule and a second calculation submodule;
    所述第一计算子模块用于计算所述当前齿尖高度与所述目标齿尖高度之间的差值;所述第二计算子模块用于基于所述差值以及所述差值的导数,确定所述动臂手臂增量。The first calculation submodule is used to calculate the difference between the current tooth tip height and the target tooth tip height; the second calculation submodule is used to calculate the difference based on the difference and the derivative of the difference , to determine the boom arm increment.
  6. 根据权利要求1至5任一项所述的平地辅助系统,其特征在于,所述系统还包括辅助单元,用于在检测到左右手柄均处于下拉状态的情况下,生成内拉平地作业指令,以使所述整车控制器基于所述内拉平地作业指令进行内拉平地作业,或在检测到左右手柄均处于上推状态的情况下,生成外推平地作业指令,以使所述整车控制器基于所述外推平地作业指令进行外推平地作业。The ground leveling auxiliary system according to any one of claims 1 to 5, characterized in that the system further comprises an auxiliary unit, configured to generate an internal leveling operation command when it is detected that both the left and right handles are in the pull-down state, so that the vehicle controller can perform the internal leveling operation based on the internal leveling operation command, or generate an external push leveling operation command when it detects that both the left and right handles are in the push-up state, so that the entire vehicle The controller performs an extrapolated ground leveling operation based on the extrapolated ground leveling operation instruction.
  7. 一种基于如权利要求1至6任一项所述平地辅助系统的平地辅助方法,其特征在于,包括:A leveling assistance method based on the leveling assistance system according to any one of claims 1 to 6, characterized in that it comprises:
    获取作业机械的当前位姿;Obtain the current pose of the operating machine;
    接收携带有平地作业方向的平地作业请求,并基于所述平地作业方向以及所述当前位姿,确定所述作业机械的下一位姿,以及基于所述下一位姿,生成当前平地作业指令,以使所述作业机械的整车控制器基于所述当前平地作业指令进行平地作业。receiving a leveling operation request carrying a leveling operation direction, and based on the leveling operation direction and the current pose, determining the next posture of the working machine, and generating a current leveling operation instruction based on the next posture , so that the vehicle controller of the working machine performs leveling operations based on the current leveling operation instruction.
  8. 一种作业机械,其特征在于,包括:如权利要求1至6任一项所述的平地辅助系统。An operating machine, characterized by comprising: the ground leveling auxiliary system according to any one of claims 1 to 6.
  9. 一种电子设备,包括存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,其特征在于,所述处理器执行所述程序时实现如权利要求7所述平地辅助方法的步骤。An electronic device, comprising a memory, a processor, and a computer program stored on the memory and operable on the processor, wherein the processor implements the program described in claim 7 when executing the program. Steps of the Level Assist method.
  10. 一种非暂态计算机可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现如权利要求7所述平地辅助方法的步骤。A non-transitory computer-readable storage medium, on which a computer program is stored, characterized in that, when the computer program is executed by a processor, the steps of the leveling assistance method as claimed in claim 7 are realized.
PCT/CN2022/076590 2021-09-28 2022-02-17 Land leveling assistance system and method, and operation machine WO2023050684A1 (en)

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
CN202111145794.7A CN113944197B (en) 2021-09-28 2021-09-28 Land leveling auxiliary system, method and working machine
CN202111145794.7 2021-09-28

Publications (1)

Publication Number Publication Date
WO2023050684A1 true WO2023050684A1 (en) 2023-04-06

Family

ID=79328911

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/CN2022/076590 WO2023050684A1 (en) 2021-09-28 2022-02-17 Land leveling assistance system and method, and operation machine

Country Status (2)

Country Link
CN (1) CN113944197B (en)
WO (1) WO2023050684A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116539040A (en) * 2023-04-11 2023-08-04 黑龙江惠达科技发展有限公司 Agricultural automatic land leveling target inclined plane determining method and device

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113944197B (en) * 2021-09-28 2023-04-07 上海三一重机股份有限公司 Land leveling auxiliary system, method and working machine
CN115387426B (en) * 2022-08-29 2023-11-28 三一重机有限公司 Control method, device and equipment of working machine and working machine

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102282925A (en) * 2011-05-26 2011-12-21 中国农业大学 Land leveling method and device as well as land leveling control device
CN105604120A (en) * 2014-11-14 2016-05-25 卡特彼勒公司 System for assisting a user of a machine of a kind comprising a body and an implement movable relative to the body
US20160312434A1 (en) * 2015-02-02 2016-10-27 Komatsu Ltd. Work vehicle and method of controlling work vehicle
WO2021251463A1 (en) * 2020-06-11 2021-12-16 日本精機株式会社 Work assist system and work assist method
CN113944197A (en) * 2021-09-28 2022-01-18 上海三一重机股份有限公司 Land leveling auxiliary system, method and working machine

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR101572759B1 (en) * 2014-04-23 2015-11-30 울산대학교 산학협력단 Self optimizing excavator system and method for controlling using the same
CN104120745B (en) * 2014-07-28 2016-08-24 三一重机有限公司 A kind of excavator automatic land smoothing control method
CN111042245B (en) * 2019-12-31 2022-04-05 潍柴动力股份有限公司 Excavator auxiliary operation control method and system
CN113250255B (en) * 2021-06-08 2022-08-19 上海三一重机股份有限公司 Engineering machine control method and device based on electronic enclosing wall and engineering machine
CN113338371B (en) * 2021-06-18 2023-02-03 三一重机有限公司 Excavator flat ground control method and system

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102282925A (en) * 2011-05-26 2011-12-21 中国农业大学 Land leveling method and device as well as land leveling control device
CN105604120A (en) * 2014-11-14 2016-05-25 卡特彼勒公司 System for assisting a user of a machine of a kind comprising a body and an implement movable relative to the body
US20160312434A1 (en) * 2015-02-02 2016-10-27 Komatsu Ltd. Work vehicle and method of controlling work vehicle
WO2021251463A1 (en) * 2020-06-11 2021-12-16 日本精機株式会社 Work assist system and work assist method
CN113944197A (en) * 2021-09-28 2022-01-18 上海三一重机股份有限公司 Land leveling auxiliary system, method and working machine

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN116539040A (en) * 2023-04-11 2023-08-04 黑龙江惠达科技发展有限公司 Agricultural automatic land leveling target inclined plane determining method and device
CN116539040B (en) * 2023-04-11 2024-01-26 黑龙江惠达科技发展有限公司 Agricultural automatic land leveling target inclined plane determining method and device

Also Published As

Publication number Publication date
CN113944197B (en) 2023-04-07
CN113944197A (en) 2022-01-18

Similar Documents

Publication Publication Date Title
WO2023050684A1 (en) Land leveling assistance system and method, and operation machine
JP2682891B2 (en) Excavator control equipment for power shovel
US9008919B2 (en) Swing control apparatus and method of construction machinery
CN109291055B (en) Robot motion control method, device, computer equipment and storage medium
MX2007014548A (en) Enabling a graphical window modification command to be applied to a remotely generated graphical window.
US11779843B2 (en) Virtual object control method and apparatus, storage medium, and electronic device
JP2017071982A (en) Construction machine
WO2022121003A1 (en) Robot control method and device, computer-readable storage medium, and robot
WO2023108986A1 (en) Control method for boom, and boom apparatus, engineering vehicle and readable storage medium
WO2021159784A1 (en) Operation protection method and system for speed reducer for robot, and storage medium
WO2022257537A1 (en) Construction machine control method and apparatus based on electronic fence, and construction machine
JP2021107221A (en) Method for adjusting automobile seat, device, apparatus and storage medium
WO2024077881A1 (en) Scheduling method and system for neural network training, and computer-readable storage medium
WO2022193556A1 (en) Motor phase loss detection method and device, and storage medium
CN113059256B (en) Welding control method, system, equipment and storage medium of double-wire welding system
JP4446068B2 (en) Numerical control device for machine tool and numerical control method for controlling machine tool
CN116043937A (en) Control method for excavator, processor, excavator and storage medium
CN109015648A (en) A kind of control method of robot, device, storage medium and robot
KR101805333B1 (en) Apparatus and method for controlling assistant power of hybrid excavator
CN113650685B (en) Method and device for controlling rotation of working machine, electronic device, and storage medium
JPH03201105A (en) Visual correction positioning device
CN110588543A (en) Front radar and panoramic camera control device and method
CN217085551U (en) Auxiliary control device and working machine
TWI837986B (en) Method for determining screw adjustment result and interactive wrench
CN103452161B (en) A kind of trailing suction hopper dredger essence digs control method

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: 22874087

Country of ref document: EP

Kind code of ref document: A1